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Chapter  1. 


Introduction 


1.1  Problem  Description 

This  tlicsis  deals  with  the  time-optimal  control  of  a  tendon  arm  system.  The  tendon  arm  system 
consists  of  a  rigid  link  attached  to  a  base  plate  through  a  three  degree-of- freedom  joint  thus  affording  the 
arm  rotational  freedom  in  three  axes  Movement  of  the  arm  is  made  possible  by  four  tendons:  one  end 
of  each  tendon  is  attached  to  the  top  of  die  arm  and  the  other  end  is  wound  on  a  motor  shaft  located 
under  die  base  plate.  The  design  of  the  tendon  attachments  is  such  that  through  the  interaction  of  die 
four  motors  and  tendons,  and  by  controlling  die  current  input  (or  torque  output 1  of  die  motors,  control  of 
die  movement  of  the  arm  in  three  axes  is  possible.  Section  2.1  contains  a  more  detailed  description  of  die 
tendon  arm  system,  and  figure  2-1  shows  a  schematic  diagram  of  it.  The  tendon  arm  system  is  designed  by 
John  Hollcrbach  and  Danny  Hillis  of  the  M.l.T.  Artificial  Intelligence  laboratory. 

We  arc  interested  in  designing  a  controller  to  move  the  arm  from  an  initial  position  to  any  specified 
final  position.  Time-optimal  control  is  chosen  because 

1.  it  achieves  the  desired  motion  in  minimum  time  —  this  is  desirable  because  the  faster  it  can  move,  the 

more  motion  tasks  per  unit  time  could  be  completed  this  way,  and 

2.  it  requires  few  words  of  computer  memory  to  represent  the  optimal  solution  —  traditionally,  time- 

optimal  solution  is  associated  with  bang-bang  control,  hence  the  optimal  solution  is  completely 
specified  by  the  switching  times. 

These  are  the  motivations  for  choosing  time-optimal  control,  namely,  it  yields  a  rapid-moving  system 
which  is  implcmcntablc. 

The  second  point  mentioned  in  the  last  paragraph  is  only  valid  if  the  problem  is  nonsingular.  In 
the  presence  of  singularity,  the  time-optimal  solution  need  not  be  bang-bang.  Our  problem  is,  in  fact, 
singular,  but  die  form  of  the  singular  arcs  is  such  that  the  control  signals  can  be  approximated  very  closely 


1 


2 


by  straight  line  segments,  hence  the  storage  requirements  for  such  a  control  is  quite  low  also  (about  5 
integer  words  per  trajectory). 

Since  our  system  equations  arc  highly  nonlinear  and  complicated,  it  is  not  possible  to  express  the 
optimal  solution  in  feedback  form.  Thus,  in  addition  to  this  open-loop  control,  some  sort  of  closed-loop 
control  law  is  required  to  correct  for  any  disturbances.  The  overall  control  scheme  will  consist  of  two 
phases  :  an  initial  phase  during  which  open-loop  time-optimal  control  is  app'ied.  and  a  second  phase 
which  is  feedback  regulation  at  (he  final  position. 

Although  time-optimal  control  has  been  applied  to  manipulators  (Kahn[l]),  it  does  not  shed  much 
light  on  our  problem  because  the  tendon  arm  is  different  from  conventional  manipulator  design.  The  only 
reference  that  is  available  on  tendon  arm  dynamics  is  Riemenschneidcr  et  al  [2]  but  the  paper  deals  with  a 
one  dcgrcc-of- freedom  arm  which  is  much  simpler  than  the  three  dcgrcc-of-  freedom  arm  studied  herein. 

1.2  Thesis  Outline 

This  thesis  is  organized  into  seven  Chapters: 

Chapter  1  provides  an  introduction  to  the  problem  under  study. 

Chapter  2  describes  the  physical  tendon  arm  system  and  develops  a  mathematical  model  describing  the 
system.  A  simplified  reduced-order  model  is  also  obtained,  and  the  responses  of  the  two  are  com¬ 
pared. 

Chapter  3  first  slates  the  time-optimal  control  problem  and  presents  necessary  conditions  for  the  optimal 
solution  from  Pontryagin’s  Minimum  Principle.  These  arc  then  applied  to  the  reduced-order  model 
of  the  tendon  arm  system. 

Chapter  4  presents  the  conjugate  gradient  method  and  describes  an  iterative  procedure  for  solving  our 
time-optimal  problem.  Approximation  for  the  lime-optimal  solution  is  also  proposed. 

Chapter  S  motivates  the  need  for  a  closed-loop  feedback  control  law  at  the  final  position,  and  presents  the 
linear  regulator  approach  for  designing  the  feedback  law. 


Chapter  2.  Modeling  of  the  Tendon  Arm  System 


In  order  to  study  and  develop  a  :ontro!  strategy  for  the  tendon  arm  system,  we  must  have  a  mathe¬ 
matical  model  of  it.  In  this  Chapter,  the  physical  system  is  first  described,  equations  describing  the  system 
dynamics  arc  then  developed,  and  a  reduced-order  model  is  obtained  by  ignoring  the  third  degree-of- 
freedom  of  the  arm. 

It  A  Description  of  the  Tendon  Arm  System 

The  schematic  diagram  of  die  tcr.don  arm  system  is  shown  in  figure  2-1.  It  is  a  cylindrical  rod,  known 
as  the  arm,  attached  at  one  end  to  a  oasc  plate  via  a  three  degrcc-of-frccdom  "joint".  Figure  2-2  shows 
the  "joint"  in  greater  detail.  The  outer  rectangular  block,  together  with  the  inner  member,  can  be  rotated 
about  the  Y  —  Y  axis.  The  inner  member  can  be  independently  rotated  about  the  X  —  X  axis.  The 
cylindrical  part  of  the  inner  member  can  be  rotated  about  the  Z  —  Z  axis,  i.e.  the  longitudinal  axis  of  the 
cylinder.  Potentiometers  are  mounted  as  shown  in  the  diagram  to  measure  the  three  angles  of  rotation. 
This  construction  of  the  "joint"  lends  itself  to  a  very  natural  way  of  defining  the  position  of  the  arm 
in  terms  of  the  three  angles  0,  <f> ,  and  xp,  which  arc  measured  directly  by  the  potentiometers,  as  shown 
in  figure  2-3.  This  coordinate  system  will  be  used  throughout  this  thesis  to  describe  the  arm.  Another 
coordinate  system,  described  by  the  angles  a,  /?,  and  xp,  is  sometimes  used.  This  is  shown  in  figure  2-4. 

At  the  upper  half  of  the  cylindrical  rod,  there  arc  points  of  "insertion”  (attachment)  for  four  tendons, 
two  at  one  height,  and  the  other  two  at  another.  Each  tendon  is  wrapped  around  the  arm  through  a  certain 
angle  before  it  breaks  off  from  the  surface  of  the  arm  (see  figure  2-5).  The  other  end  of  the  tendon  passes 
through  a  pulley  on  the  base  plate  and  is  wrapped  round  a  threaded  cylinder  mounted  on  the  shaft  of  a 
motor  under  the  base  plate.  As  the  motor  rotates,  the  tendon  will  be  wrapped  or  unwrapped  from  the 
motor  shaft  thereby  causing  a  shortening  or  lengthening  of  the  tendon  between  the  motor  and  the  arm. 
Through  the  interaction  of  the  four  motors  and  tendons,  the  arm  can  be  moved  from  one  position  to 
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Figure  2-1.  Schematic  diagram  of  the  tendon  arm  system 


another. 

2.2  Equations  of  Motion 


2.2.1  Coordinate  Systems  and  Coordinate  Transformation 


6 


Figure  2-1  A  more  detailed  diagram  of  the  three  degree-of-freedom  "joint" 

Pi,  P*  and  the  y-axis  along  P 2,  P\.  P\,  P2.  P3,  and  P4  arc  die  points  on  the  base  plate  through  which  the 
tendons  pass  (refer  to  figure  2-5). 

In  computing  the  dynamics  of  the  arm,  wc  refer  all  quantities  to  a  moving  coordinate  system  which 
is  fixed  to  the  arm  and  with  the  three  axes  coinciding  with  those  of  the  fixed  coordinate  system  when 
0  =  <f>  =  ip  =  0.  These  three  axes  arc  the  principal  axes  of  the  arm. 


Figure  2-3.  Angles  defining  the  position  of  the  Figure  2-4.  Another  set  of  angles  that  defines 
arm  the  position  of  the  arm 


If  P  denotes  the  coordinates  of  a  point  in  the  fixed  coordinate  system,  to  refer  it  to  the  moving 
coordinate  system,  we  need  to  perform  the  following  transformations: 

1.  a  rotation  through  an  angle  <p  about  the  y-axis,  and 

2.  a  rotation  through  an  angle  6  about  the  new  z-axis,  and 

3.  a  rotation  through  an  angle  ip  about  the  new  z-axis. 

i.e. 


P  =  Sz(iP)Sx(p)Sv{4>)P 


(2.1) 


where  P  denotes  the  coordinates  of  the  point  referred  to  the  moving  (primed)  coordinate  system,  and 
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(2.2) 


P>  =  W(0,4>,iP)P  (2.3) 


where 


W(9,<fi,  tp) 


cos  <j>  cos  tp  -(-  sin  Osin  <f>  sin  tp  cos#sint/> 
—  cos  0  sin  tp  sin  #  sin  $  cos  0  cos  0  cos  tp 
cos  #  sin  tp  — sin# 


—  sin  <p  cos  tp  -)-  sin  #  cos  tp sin  ip 
sin  <p  sin  t p  -(-  sin#cos0cost/> 
cos#  cos 

(2.4) 


2.2.2  Some  Geometric  Calculations 

Referring  to  figure  2-6  which  shows  some  parameters  of  the  arm. 
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Using  equation  (2.3), 


acos#sint/> 

—a  cos  <p  cos  tp  —  s  sin  #  sin  tp  sin  tp 

P'1  =  -Pi  = 

acos#cost/> 

P'  —  —P'  — 

>  r3  —  r4  ~ 

8  cos  <^>  sin  0  —  s  sin  #  sin  $  cos  tp 

— a  sin# 

—8  cos# sin <p 

From  now  onwards,  we  will  refer  all  quantities  to  the  moving  coordinate  system. 

Let  Q,  be  the  point  at  which  tendon  i  is  attached  to  the  arm,  and  R,  be  the  point  at  which  tendon  t  leaves 
the  surface  of  the  arm.  Then  in  order  to  calculate  the  directions  in  which  the  tendons  pull  on  the  arm,  we 
need  the  coordinates  of  the  /Vs. 


Figure  2-7.  (a)  Schematic  or  the  arm  looking  down  the  a'-axis  showing  only 
Unwrapping  tendon  1  onto  a  plane. 


w  =  ton  1 

X  =  C08~ 1 


(a  cos  0  sint/)  X 
a  cos  9  cos  rp  ) 

f-M 

\acos0/ 


where  p  is  the  radius  of  the  cylindrical  arm. 


*i  =  +psin(*  —  X  —  ui)  =  psin(u)  +  M 
V\  =  —pcos(t  —  X  —  u>)  =  p cos(u>  -j-  X) 


Referring  to  figure  2-7(b), 
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implies 


M\R\  _ Q\M\ 


zi  =  — asinfl  4 


b  4  asintf 


1  -f-  —  u >—  X)/tan  X 


L,  =  HiP!  = 
ii=Q\Pi  = 


i* 

K 


fa  +  a  sin  0)2  4  p2  tan2  Xj 
(6  +  asintf)2  +  p2(^  —  w  —  X  +  tan  X)2| 


(2.11) 

(2.12) 

(2.13) 


Similarly,  the  coordinates  of  /?2  arc  given  by. 


x%  —  —  psin(w  4  X) 

(214) 

J/2  =  — pcos(u>  4  X) 

(2.15) 

22  =  a  sin  0  4 

6  —  asintf 

(2.16) 

1  4  ~  w  —  X)/  tan  X 

-  1 

Lrl  —  R2P2  ~  | 

r 

fa  —  a  sin  0 )2  4  P2  tan2  X  [ 

(2.17) 

k  —  Q2P2  = 

(6  —  oBinfl)2  4  p2(~p  —  u»  —  X  4  tan  X)2| 

(2.18) 

Coordinates  of  R3  andR.4 

Let  (Z3,  pj,  zj)  be  the  coordinates  of  R 3  in  the  primed  coordinates. 

From  figure  2-8(a)and  equation(2.6), 

,  _)  (  —  cos<£sint/>  4  sin  0  sin  0  cos  t/> 

10  3=  tan  I  — — ■-  -■  -  —  " 

V  cos  $  cos  xf)  4  sin  0  sin  #  sin  tfi 

-  tan~'  ( ~~tan^>  -f  tanking 

V  1  4  tant/>tan^sin0 


(2.19) 


Define 


tann'  =  tan  ^  sin  0 


(2.20) 
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implies 


Mfii  =  MjQj 
n.<N}  NjP3 

*3  =  —  s  sin  <ficoa$  -f- 

Li  =  RiP,  = 

h  =  QtPt  = 


t  -f  ssin^cosf 


1  +  ( •ff  —  u/  —  X')/  tan  X' 
(zj  +  s  *i  n  ^  cos  9)2  4-  p2  tan2  X'l 


3« 


(t  -j-  isin  0cosf)2  +  p2(~  —  uj'  —  X'  -f-  tan  X')2 


Similarly,  for  R4, 


(2  25) 
(2  26) 
(2  27) 


x4  =  pcos(u/  X') 
1/4  =  P»in(u/'  -f-  X') 
z4  =  ssin^cosf  -f 


f  —  s  sin  0  coif 


1  -f  (^  -  w'  -  X')/  Un  V 
L4  —  =  |(z4  —  «  sin  0  coif)2  4-  p2  Un2  X'j 

14  ==  Q4P4  —  |(f  —  1  sin  <p  coif)2  4-  p*(  ^  —  u/  —  X'  4-  Un  X')2 


(2  28) 
(2  29) 

(2  30) 
(2.31) 
(2  32) 


Coordinates  of  the  center  of  gravity 

Let  G  be  the  center  of  gravity  of  the  arm  (see  figure  2-6),  and  let  GD  be  the  unit  vector  along  the 
direction  of  the  gravitation  field  which  will  be  assumed  to  be  vertically  down. 

Expressed  in  the  primed  coordinate  system, 

0 

G  =  0 

d_ 

sin  <t>  cos  t/i  —  sin  0  cos^  sin  if> 

GD  =  —  sin  ^  sin  0  —  sin  0  cos  ^  cos  0 
—  cos  8  cos  ^ 


(2  33) 

(2  34) 


2.2.3 


Resultant  Torque  exerted  by  the  four  Tendons  about  the  point  of  rotation  O 


LetF„  i  —  1,  ,  4,  bcihe  tension  m  tendon  t.  the  direction  of  F,  will  he  in  the  direction  of  R,P,. 


Resultant  torque  acting  on  the  arm  about  0 

=  OR  |  X  f|  "f  OR  i  x  F2  OR  i  X  Fi  -f-  ORj  x  F$  -f  OC7  X  rri  q 

-  mf*> x  fi'v' +  iR%oh‘ x  r:,,‘  +  !«'/•/*■ x 

+  ,/d.OR,  x  R\P,  +  mpOC  X  GO 

««T,  +j7*+*7j  (2.35) 


n  p 

T|  =  —  I  — pasintf  co«(u»  +  X)  —  ^acos#  custp)  -f-  pa  sin  0cos(u>  -f-  X)  -f-  a2acos0costp] 

+  -  -  [pa  sin  0  cos  0  sin(w'  -f  X')  —  *j8(cos<^sin  t/>  —  sin0sin<£cosV<)] 

L>j 

+  - -[pjsin<^cos0sin(u/  +  X')  -f  ^a(co8  0sin  ip  —  sinflsin^cos  i/>)] 

1*4 

+  mpd(sin0sin  tp  +  cos^sinflcoa  V»)  (2  36) 

n 

T2  =  7'(posin0sin(ui  +  X) +Z|acos0ain  V>1 -f  y^  [po  sin  0sin(iu -f- X)  —  *2a  cos 0 sin  v^l 

Li 

n 

-+•  — J[--/wsin^coB0coB(u/ +  X')  —  ^b(cob^cob0  +  sin  <p  sintfsin  0)] 

-f  y-4  [— ps  sin  0  cos 6  cos(u/  +  X')  +  *ia(coa  0  cos  ^  -f  sirup  sin  6  sin  ^)] 

L-4 

-f-  mpd(sin  </>cot\p  —  cos  ^  sin  0  sin  V*)  (2  37) 

7j  —  ^  +  ^^pa cos$ sin  X  +  +  p^ps[sin^sin0 cos(X'  +  n')  —  cos0sin(X'  -f-  p')]  (2.38) 


Note:  The  expressions  in  equations  (2.36H2.38)  arc  derived  based  on  the  geometry  of  the  arm  as 
described  in  section  2.2.2.  which  assumes  that  all  the  tendons  arc  wrapped  properly  on  the  arm.  In  the 
course  of  moving  from  one  position  to  another,  one  pair  of  the  tendons  might  be  completely  unwrapped, 
hence  the  expressions  developed  above  will  not  be  valid. 

Referring  to  the  notations  used  in  section  2.2.2: 

ifw  -f  X  >  3*/4,  then  tendons  1  and  2  have  completely  unwrapped,  and 

if  J  -f  X'  >  3x/4,  then  tendons  3  and  4  have  completely  unwrapped. 
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Appendix  A  develops  the  corresponding  expressions  for  equations  (2.36M2  38)  in  the  event  of  either  pair 
of  tendons  is  unwrapped.  Ihcse  expressions  arc  only  approximations  as  the  tendon  insertion  is  not  ideal. 


2.2.4  Arm  and  Motor  Dynamics 

Fulcr’s  dynamical  equations  for  the  rotation  of  a  rigid  body  about  a  point  O  are  given  by, 

J'l!t  -  -  ^)n2n3  =  n 

-(h-JiWi  =T2  (2  39) 

-  (-A  -  ^)n,n2  =  t3 

where  the  subscripts  1.  2.  3  refer  to  the  three  principal  axes  of  the  rigid  body,  fi „  J,  are  the  angular 
velocity  and  the  moment  of  inertia,  respectively,  of  the  arm  along  the  i-axis,  and  T,  is  the  external 
applied  torque  on  the  body. 

By  making  the  identification  of  the  y'-,  /  -axes  of  the  arm  primed  coordinate  system  with  the 
1-,  2-,  3-axcs  of  the  above,  we  can  apply  equation  (2.39)  to  the  tendon  arm  system,  with  the  simplifying 
assumption  that 

J\  =  J2  =  (2.40) 


This  assumption  is  valid  because  the  contribution  of  the  moment  of  inertia  of  the  lower  rectangular  block 
about  point  O.  which  is  asymmetrical  about  the  /-axis,  is  negligible  compared  to  that  of  the  cylindrical 
rod.  which  is  symmetrical. 

Fxpressing  the  fl,’s  in  terms  of  the  three  anglcsfl,  <p  and  ip,  we  obtain. 


n,' 

0coat />  -f  </>cos0sin  V 

n  = 

n2 

= 

— 0sin  ip  -j-  <P  co* $  coa  ip 

n3. 

— 0'ain  f  + 

(2.41) 


T|,  Ti,  7j  arc  given  by  equations  (2.36H2.38)  The  tensions F\ ,  F2,  Fj,  F4  in  the  tendons  arc  related 


to  the  input  currents  to  the  motors,  1\,  Ij,  /j,  I4,  through  the  motor  dynamics 


JmX  +  B„a,  +  Fi r  =  Kli  i  =  1, .... 4  (2  42) 


where 

is  the  angular  velocity  of  the  motor  shaft, 

Jm  is  the  moment  of  inertia  of  the  motor  shaft, 

Bm  is  the  velocity  dependent  friction  coefficient, 
r  is  the  radius  of  the  cylinder  mounted  on  the  motor  shaft,  and 
K  is  the  torque  constant  of  the  motor. 

Because  of  the  constraint  that  the  tendons  must  be  taut  at  all  time,  and  the  assumption  that  the 
tendons  are  inelastic,  the  angular  rotation  of  each  motor  is  related  to  that  of  the  arm. 

Specifically, 

—  (2  43) 


where  1,(0, <p,  ip)  is  the  length  of  tendon  t  (from  point  Q,  to  point  P,)  when  the  arm  is  at  the  position 
defined  by  0. tp,  ip.  and  lo  =  /,( 0, 0, 0),  which  implies  that  7,  =  0  when  0  =  <p  =  ip  =  0. 

By  differentiating  equation  (2.43)  with  respect  to  time  once,  we  obtain 


Hi  =  ~ 


(2«) 


By  differentiating  once  more, 


Hi  =  - 


d0$  +  dp*  +  ^p'P  +  +  ^2<t>  +  =5* 


do 2 


dip2 


dip 2 


+ + 2^P^ + 


(2.45) 


By  substituting  equations  (2.44H2.45)  into  equation  (2.42),  we  can  obtain  expressions  for  the  Pi’s  in 
terns  of  the  7,’s  and  the  three  angles  0,  <P,  and  ip.  By  substituting  these  into  equations  (2.36H2.39),  a  set 
of  differential  equations  describing  the  dynamics  of  the  tendon  arm  system  is  obtained. 
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By  defining, 

x  =  [6  <f>  V*  8  4  ii>]T 
ti  =  (/i  h  h  U\T 

and  rearranging  terms,  we  obtain  the  equations  of  motion  of  the  system  in  the  form, 

z(t)  =  Fo(r(l))  +  H,(x(t))u(t) 


(2.46) 

(2.47) 


(2.48) 


where 

F0(z)  is  a  6  vcctor,  and 
Bo(x)  is  a  6  X  4  matrix. 

The  full  detail  of  equation  (2.48)  is  given  in  Appendix  B. 

13  Reduced-Order  Model 

The  equations  of  motion  obtained  in  the  previous  section  is  too  complicated  to  be  useful  in  the 
design  of  a  controller.  Much  of  the  complications  arises  from  the  geometry  of  the  tendon  arm  system. 

A  simplified  fourth  order  model  is  obtained  by  ignoring  the  tendon  wrapping  about  the  arm,  thereby 
reducing  the  three  degree-of- freedom  arm  to  a  two  dcgrcc-of- freedom  one.  This  is  achieved  by  equating  p 
to  zero  (recall  that  p  is  the  radius  of  the  cylindrical  arm). 

».e., 

p  =  0  (2.49) 

This,  in  efTect,  is  to  ignore  the  twisting  movement,  x(>,  of  the  arm. 

Equations  (2.39)  become: 

7(0  +  ^7sin0cos0)  =  ^  ~  —  p^aAcoB0  —  —  y^af  sin  fain#  -f  mgdsinO  cos  4>  (2.50) 

J(^cos0  —  20<£8in0)  =  —  ^^afeos^-)-  mpdsin^  (2.51 ) 
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20 


ab  cos  0 


+  4> 


+  "\li  d0  h  d0J  + 

(_idh  ,  i«4 

V  isd*^  kdt 


8<sin0sin0 
ab cos 0 


Jr 


8t  si n  0  sin  t? 
ab cos  0 


(_  1«3  ,  i^U\] 
\  hd0  +  i4do)\ 


-«<H) 


st  sin  0  sin  0 
ab cos  0 


HH) 


+  m9 


dr2  sin  6  cos  <t> 
ab  cos  0 


■st  sin</>sin0  n 

T  4> - r - a — 

ab  cos  0 


(lei b  _  I«A 
\hc<t>  l4  dtp) 


.jo  17  1  dl\  ,  1  diA  ,  st  sin  4>  s\n  0  f  l  dlj  1  <»4\1 

+  '"[V  hdO^l2d0j+  ab  cos0  \l3d0  l4d0  J] 

4-  2 1  *k  _  I 

^  V  o6cos<?  \hddd<l>  Ud0d<t>  J 

•2  stsin</>sin0  l<92i3  l<92/4\  ,r2sinfl 

+  *  abcosr  "|i3^  ~  i~4<9^  J  ab 


+  *Vr 


1  dll\  ,  1  <f2/2^  ,  st  sin^sintff ld2^  ld^YI 
^  +  F2do*)+~~  ~ 


r r2 cos 0  ,  r  fid l3 


+H«-f 


S<  COS  0 


+  0/, 


abcosO  yhdO2 

fl<*3 


<4<*2 /| 


-f  mg  — -  tan  <j>  -f 
81 


[ia(j_  l«3l 

‘[/3<»  l4S0  J 

(-1*2  . 

\  h ^  wj 


(2.55) 


+  204>  J  + 

st  COS  <p 


-f  0S, 

1^3 


/_1*  ,  1^4^ 

\  tsdo^Udo) 


\  hdOdQ  ^  l4d0&p )\^v  \  h 


ISh 

hdo 

—  +  l*k) 

he*2  ^  i4dd>2  j 


(2.56) 


By  defining. 
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_  1  dU  __  1  dli 
1 °~~lidO  U  dO 

_  i_dh  ia4 

20  lj  ae  k  SO 

_  1  d.%  l  d% 
L'00  ~  {,  de 2  i2  do 2 

_  is%  _  l^i, 
Lm~uae2  use2 

_  mr} _ 2<5«4 

2o~  Ud<p  i.\S<p 

_  l  ^ 

1200  ~  u^  l,S4>2 

l  1 

L'l0°  uses#  uses? 

st  sin^sinf? 
ad  cos# 


(2.57) 


and 


N  = 


Jr2/abcos0  + 

JrnLie 


-  2v 

Jr*  co&O jst  c <>*■,•>  t 


(2  58) 


Equations  (2.55H2  56)  can  be  written  as: 


vr 

6 

=  N~l 

— Kr/l\  Kr/l2  eKr/l  j  -eKr/U 

7? 

+  N-"1 

! 

tan  9  cos  <pdr2/ab 

A 

0  0  -tfr/fe  Kr/7., 

/j 

tan  <pdr2/st 

A 

+  N“‘ 
+  N-1 
+  N_I 


cBtnU  2<fr 
BtriL/2tp 


U+N 


—  i 


—B 


/.(M,M) 


C*/ tti-7/26  O 

Jr 2  sin  0/st  cos  <f>  —  J,nLio<p 

eJmL2<p<i>  —  J^2  sin0/a6 

J 

h  (M) 


,Lig  ei3„iL2o"j 

BjnB  20  J 

2  00 


— J,nL\00  -f  eJ»J'i06 
— JmL'ioe 


e2 


+ 


u 


mg 


(2.59) 


where  u  =  (/|  /j  h  /*]r. 


i 


x  —  [o  <p  $  4]t 


the  reduced-order  model  can  be  written  as: 


x(t)  =  F(x[t))  +  B(x(t))u 


(2  60) 


where 


13(f) 

F(x(t))  = 

x4(t) 

/a(*(f)) 

M*  (0) 

0 

__  1 

B(x(t))  = 

0 

frj(zi(<),  *2(<)) 
64(ii(f),i2(f)) 

a  4-vcctor 


a  4  X  4  matrix 


(2.61) 


(2.62) 


Note:  It  can  be  easily  shown  from  equation  (2.58)  and  several  simple  substitutions  dial  the  detcmiinant 
of  N  is  always  greater  than  zero  for  all  9,  <j>  between  (but  not  including)  —  ir/2  and  -(-ir/2.  Hence  N~l 
always  exists. 


2.4  Comparing  the  Responses  of  the  Full  and  Reduced-order  Models 

To  investigate  the  cfTccl  of  representing  a  sixth-order  system  by  a  fourth-order  model,  a  step  of  mag¬ 
nitude  four  is  applied  to  both  I2  and  U  of  the  hill  (sixth)  and  reduced  (fourth)  order  models  developed  in 
sections  2.2  and  2.3  respectively. 

The  responses  of  the  two  models  arc  shown  in  figure  2-9  and  tabulated  in  Table  2-1.  (The  values  of 


the  parameters  used  is  given  in  Appendix  G). 


ll  can  be  seen  dial  the  difference  between  the  two  is  small  except  for  the  fact  that  the  reduced  order 


system  cannot  model  die  angle  ip. 


Table  Z-\  (a)  Response  of  Hie  Full  Order  Model  due  to  step  inputs  on  lt  and  I4 . 


Time 

(nwee) 

G 

( radian) 

( radian ) 

(radian) 

9 

|sec) 

4> 
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<P 
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0 
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10 

00020 
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| 

0  3306 

-0  0877 

20 
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30 

00103 

O  01 4*? 

-0  004/ 

1  2226 
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-0  2856 

40 

0  0326 
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-0  0075 

1-6320 

1  332* 

-0  4000 

50 

0  0510 

0-04-16 

-  0  0123 

2-046/ 

f  6766 

-0  5543 

60 

0  0735 

0  0601 

-0  0181 

2-4637 
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70 

O 1003 

0  0022. 

-0-0271 

2  6662 

2-  3*70 

-  O  *46* 

60 

01313 
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-  O  0370 

1 

3-3141 

2  7628 

-1  2073 

*10 

0-1666 

O  1380 

-0  05/4- 
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5- 1*47 

-f  -52-/4 

1 00 

0  2063 
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-  l-f»*S3 
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0-2M0 

-O  0875 
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-01/54 
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-2  0546 
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03517  03054. 

-  0-  146* 
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0  4o*o 
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no 
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0-6756  0-704! 

I 

-  0  40 5 ] 
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11-8005 
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Tabic.  2-1  (t>)  Response  of -tie  Reduced  order  hodel 
due  to  Step  Inputs  on  Xz  and  I4 


Tirpe 
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_ 
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Chapter  3.  The  Time-Optimal  Control  Problem 


As  mentioned  in  Chapter  1.  we  would  like  to  devise  a  control  scheme  to  bring  the  arm  from  its  initial 
position  to  any  specified  final  position  as  fast  as  possible,  t.e..  given  any  desired  position  z/,  we  would  like 
to  find  the  control  u(<)  which  drives  z(t)  —  z/  to  zero  in  minimum  time,  where  x(t)  is  the  actual  position 
of  the  arm  at  time  t. 

In  this  Chapter,  we  will  first  fo'mally  state  the  time-optimal  control  problem  as  applicable  in  our 
case,  and  Pontryagin’s  Minimum  Principle  will  then  be  used  to  derive  necessarv  conditions  for  the  time- 
optimal  solution.  We  will  then  examine  the  time-optimal  control  of  the  tendon  arm  system  using  the 
reduced-order  model. 

3.1  Problem  Statement 

Given  the  dynamical  system  with  state  x(t)  and  control  u(f), 

*(0-F(z(0)  +  fl(x(f))u(t)  (3.1) 


where 

x(t )  is  a  4-dimensional  vector 
u(t)  is  a  4-dimensional  vector 
F(z(t))  is  a  4-vector-valued  function 
B(x(t ))  isa(4x  4)-matrix-valued  function 

Find  an  admissible  control  u(<)  which  takes  the  system  from  the  initial  state  xq  to  the  final  state  xj  in 
minimum  time.  t  .e.  find  u(  )  to  minimize  the  following  cost  function: 


(3.2) 


where  an  admissible  control  u( )  is  defined  to  be  one  such  that  every  component  satisfies  the  following 
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magnitude  constraint, 


Um,n  <  U,(<)  <  limax  *  =  1,  ....  4 


or  written  more  compactly 

u(<)  E  fi  for  all  t  E  [to,  </] 

t/  in  equation  (3.2)  is  free,  and  is  part  of  the  optimal  solution. 

In  addition,  F(x(t))  and  B(x(t))  arc  assumed  to  posssess  die  foliosing  properties: 

1 .  /,(x)  and  b,j(x)  are  continuous  in  x ,  and 

2.  df(x)/dxi,dbij(x)/dik  arc  continuous  in  x, 

where  f,(x),  bij(x),  xj.  are  components  of  F(x),  B(x),  and  x  respectively. 


(33) 


(3.4) 


3.2  Application  of  the  Minimum  Principle 

Pontryagin’s  Minimum  Principle  (Athans  &  Falb[3])  furnishes  us  with  necessary  conditions  which 
the  time-optimal  control  u(t)  must  satisfy.  Any  control  ue(t)  that  satisfies  all  the  necessary  conditions 
is  known  as  an  extremal  condition,  and  is  a  candidate  for  the  optimal  control.  If  a  time-optimal  control 
exists,  and  if  there  arc  more  than  one  extremal  control,  then  the  one  with  the  smallest  cost  given  by 
equation  (3.2)  is  optimal. 

In  order  to  apply  the  Minimum  Principle,  we  will  define  the  Hamiltonian: 

H(x{t),  p{t),  u(f))  =  1  +  pT (t)[F(x(t))  +  B(x(0)u(()]  (3.5) 

where  p{<)  is  a  4-dimensional  costate  vector. 

Let  u*(()  be  an  admissible  control  which  transfers  the  system  from  xq  to  x/,  and  let  z'(t)  be  the 
corresponding  trajectory.  In  order  for  tt'(()  to  be  optimal,  it  is  necessary  that  there  exist  a  function  p'(() 
such  that: 

(a)  p*(()  and  x*(0  arc  a  solution  of  the  canonical  system: 
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*'(0  ~^(x{i),P*{t),u[t)) 

P  (0  =  -^(*‘(0,P*(0.  u(0) 


satisfying  the  boundary  conditions 


z’(<o)  —  *o 
x'(tf)  =  1/ 


(b)  For  ail  t  G  (to,  </), 


H(x‘(t),  p’(t),  u'(t))  <  H(x’[t),  p*(t),  u)  for  all  u  G  O 


(c)  For  all  t  G  [<o,  t/\. 


H(x‘[t),p*(t),  u*(t))  =  Q 


(3.10) 


Tltis  is  a  consequence  of  free  terminal  time  and  time  invariance  of  the  system. 

Atlians  &  Falb(3]  presents  a  heuristic  proof  of  the  Minimum  Principle,  whereas  a  formal  proof  can  be 
found  in  Pontryagin  et  ol(4J. 


3.3  Bang-Bang  Control 


Substituting  equation  (3.5)  into  (3.9),  necessary  condition  (b)  reduces  to 


p,T(t)B(x'(t))u(t)  <  p'T(t)B(x*[t))u  for  all  u  G  n 


or  written  in  component  form. 


;  =  l  l  J  S 


(3.12) 
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for  all  Uj  satisfying  equation  (3.3). 

If  we  define 

4 

•;W»EM*‘WK{0  ;=!.-•  .4  (313) 

1=1 

Hquation  (3.12)  then  becomes 

(an) 

7  =  1  7  =  1 

The  control  u*(t)  which  satisfies  the  above  inequality  and  subject  to  the  cons'  raint  of  equation  (3.3)  is 
given  by 

U*(t)  =  Umax  if  <7*(f)  <  o 

u*(<)  =  umin  if  <?*(<)  >  0  j  =  1 _ 4  (3.15) 

u*(f )  indeterminate  if  q'(t)  =  0 

We  sec  that  u*(t)  is  well-defined  by  equation  (3.15)  if  there  is  only  a  countable  set  of  times  t,j  £  (lb,  t/ J 
such  that 

?’(M  =  0 

Under  this  condition,  every  component  u*[t)  of  the  optimal  control  u‘(t)  is  a  piecewise  constant  function 
of  time,  u*(t)  is  then  known  as  a  bang-bang  control,  and  we  say  that  the  problem  is  Normal. 

If,  on  the  other  hand,  there  is  one  (or  more)  subinterval  [(m,  t„J  within  [<o,  (/)  such  that 


q*(t)  =  0  for  some  j  and  all  t  €  (!,„,  1„] 

then  u*(l)  is  not  defined  by  equation  (3.15)  for  i  £  [fm,  <„),  and  wc  s  y  that  we  have  a  singular  time- 
optimal  problem;  the  time  interval  |(m,  („]is  called  the  singularity  interval. 

Hence  we  sec  that  if  the  problem  is  normal,  the  time-optimal  control  is  bang-bang.  For  linear 
time-invariant  system,  we  can  derive  necessary  and  sufficient  conditions  for  the  time-optimal  problem  to 
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be  normal  (sec  eg.  Athans  &  Falb(3])  or  singular,  but  for  general  nonlinear  systems,  there  is  no  such 
conditions,  hence  it  is  very  difficult  to  rule  out  the  existence  of  singularity  intervals  before  solving  the 
problem. 

3.4  Time-Optimal  Control  of  the  Tendon  Arm  System 

For  the  tendon  arm  system,  the  equations  corresponding  to  equation  (3.1)  arc  given  by  equations 
(2.60M2.62)  which  describes  the  reduced-order  model. 

Since  the  tendons  can  only  pull  but  not  push  on  the  arm,  there  is  a  non-negativity  constraint  on  the 
control,  and  equation  (3.3)  will  now  be  replaced  by 


o  <  u,(0  <  IW  1  =  1,  ...4  (3.16) 

The  expression  for  B{x{t))  can  be  obtained  from  equations  (2.62)  and  (2.59): 

If  wc  represent  N~ 1  in  equation  (2.59)  by 


N~l  = 


hu  h|2 
lAat  f*22. 


(3.17) 


Then 


'6,i 

612 

[ — /Tr/Ij  Kr/h  eKr/h 

— eKr/h 

.621 

622. 

0  0  - Kr/h 

Kr/lA 

631 

632 

633 

634 

.641 

642 

642 

644. 

=  Kr\ 


-hu/h 
— hi/li 


hti/h 

Ku/li 


— (hn  —  ehnJ/Ij  (h|2  —  ehu)/U 
— (^22  —  (^22  —  ehil)/k 


(3.18) 


and  from  equation  (2.62), 


6,2  =  0  fori  =  1,2,  ,4 


(3.19) 


Substituting  equations  (3.18)  and  (3.19)  into  (3.13),  we  obtain  the  follow  ing  expressions  for  q*(t): 


«!(0  =  ~Kr 


feiiPj(0+*2iP^(0 


,;(i)  = 

h 

(^  —  c^n)pj(<)  +  (hu  —  ehii)p\{i) 
q3{t)  =  -hr - - - 


94(0  =  Kr 


(hi2  —  ehn)pj(t)  4  (/i22  —  e/i2i)p4(<) 


The  q*(t)’s  will  be  used  in  equation  (3.15)  to  determine  the  value  of  u(t).  Since  the  sign  and  not  the 
magnitude  of  q'(t)  is  important,  and  since  K,  r,  l„  i  =  1, . . .,  4  arc  all  positive,  we  will  define  a  new  set  of 
9*(<)  that  can  also  be  used  in  equation  (3.15): 


?|(0  =  -(*llPj(0+/l2lP4(t)) 

£(t)  =  hnp3(t)  +  h.np\(t) 

93(0  =  —((^12  -  e^n)p3(<)  +  (^22  -  e/t2i)P4(0) 
q4(t)  =  (/112  —  </in)pj(t)  +  (^22  —  c^»2i)P4(0 


(3.21) 


and  the  optimal  control  u(t)  is  given  by 


U*{t)  =  Umax  if q]{t)  <  0 

Uj(t)  =  0  if  9>(0  >  0  J  =  1, ...  4  (3.22) 

u*(t)  indeterminate  if  q*(t)  =  0 

where  $*(<)  is  given  by  equation  (3.21). 

Note  that  in  equations  (3.21), 

$.(0 =  $2(0 

93(0 = -$i(o 

If  we  define  new  variables  qj2(0. 934(0  8ivcn  by 


9l2(0  =  9]m  ~  “(fcllPs(0  +*2lP4(0) 

934(0  =  93(0  =  “((*12  -  <*ll)Pj(0  +  (^22  -  <*2l)P4(0) 


(3.23) 
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Then  equations  (3.22)  can  be  rewritten  as 

if  <  0, 

“|(0  —  “man 

“1(0  =  0 

'f  9i2(0  '> 

«ko « o, 

^(0  =  ^mo* 

(3  24) 

if  q\2{t)  =  0, 

“1(0.  “j(0 

indeterminate 

and 

if  qM(t)  <  0, 

“3(0  —  “man 

“1(0  =  0 

if  <?j4(0  >  0, 

“1(0  =  0, 

“1(0  —  “nu.i 

(3  25) 

if  934(0  -  °. 

“1(0.  “1(0 

indeterminate 

From  equations  (3.24)  and  (3.25),  we  see  that  there  is  a  certain  relation  between  uj(0  and  between 
uj(<)  and  u*,(<).  except  in  the  case  when  <?j2(0  =  0  or  q\A(t)  =  0-  The  four  control  components  seem  to 
work  in  pairs.  u*(<)  and  u2(t)  forming  one  pair,  u*(()  and  u*,(()  forming  the  other.  This  agrees  with  the 
physical  situation,  in  which  tendons  1  and  2  form  one  pair,  and  tendons  3  and  4  form  the  other. 

Necessary  conditions  (a)  and  (c)  apply  directly  to  the  tendon  arm  system  with  the  appropriate 
definition  of  the  Hamiltonian  function. 


C  hapter  4.  Iterative  Solution  of  the  Time-Optimal  (  ontrol  Problem 


4.1  Introduction 

In  Chapter  3,  we  have  seen  that  die  Minimum  Principle  provides  us  with  neccssar>  conditions  that 
the  optimal  solution  must  satisfy.  In  particular,  manipulation  of  necessary  condition  (b)  yields  equations 
(3.24)  and  (3.25)  which  express  u*(t)  in  terms  of  x'(t)  and  p*(l).  If  the  problem  is  non-singular.  u[t)  is 
well-defined  and  theoretically  we  can  solve  the  time-optimal  control  pioblcm  by  eliminating  u’(t)  from 
tile  canonical  system  given  by  equations  (3.6)-(3.8),  and  solving  the  resulting  two-point  boundary  value 
problem  to  obtain  x '(()  and  p‘(().  and  hence  u'(t).  But  two-point  boundary  value  problems  arc  very 
difficult  to  solve  analytically  except  for  some  simple  cases.  Hv„u  for  higher  order  linear  and  nonlinear 
systems,  we  must  in  general  resort  to  iterative  methods  to  obtain  solutions. 

A  solution  obtained  by  any  iterative  method  is  characterized  by: 

1.  it  is  only  applicable  to  a  specified  initial  and  final  position  pair,  l  o  obtain  solutions  for  other  pairs,  we 

have  to  repeat  the  entire  iterative  solution  procedure,  and 

2.  it  is  expressed  as  a  function  of  time. 

The  first  statement  means  that  we  have  to  precompute  and  store  the  control  trajectories  of  every 
relevant  initial-final  position  pair,  the  second  means  that  the  control  is  open-loop  and  hence  cannot 
correct  for  any  departure  from  the  intended  trajectory  due  to,  say,  external  disturbances.  These  are 
disadvantages,  but  since  the  complexity  of  our  system  precludes  any  other  solution  approach,  we  have  to 
employ  the  iterative  approach  and  take  into  account  the  aforementioned  disadvantages  in  the  design  of 
the  overall  control  scheme  which  will  be  discussed  in  later  Chapters. 

Plant[5|  and  Mufli[6j  provide  a  surveys  of  various  computational  methods  in  optimal  control  problems 
and  each  contains  a  long  list  of  supporting  references.  Ihe  criteria  for  choosing  an  iterative  method  for 
our  problem  arc  that. 
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1.  it  is  easy  to  code,  and 

2.  it  can  handle  singular  problems. 

The  second  point  is  essential  because  as  mentioned  in  Chapter  3,  the  possibility  of  the  presence 
of  singularity  cannot  be  ruled  out.  and  in  fact,  from  some  preliminary  runs  using  the  steepest  descent 
method,  one  pair  of  controls  docs  not  approach  bang-bang,  indicating  that  the  pioblcm  might  be  singular. 

There  arc  some  computational  methods  developed  exprcssl}  for  singular  poblcins  (see  eg.  |7]-[10]). 

But  die  Conjugate  Gradient  method  is  chosen  because 

1.  it  is  basically  a  first  order  method,  lienee  its  implementation  is  simple,  and 

2.  it  converges  quadratieally  near  the  optimum  solution,  and 

3.  it  can  handle  singular  problems. 

t 

4.2  The  Conjugate  Gradient  Method 

The  first  order  gradient  method  is  easy  to  implement  but  suffers  from  slow  convergence  near  the 
optimal  solution.  In  1967,  the  Conjugate  Gradient  Method  was  applied  to  optimal  control  problems  [11). 

[12J.  The  convergence  rate  of  this  method  is  superior  to  the  gradient  method  with  very  little  additional 
computation  per  iteration.  Pagurck  &  Woodsidc[13]  and  later  Quintana  &  l)avison[14)  extended  the 
method  to  problems  having  bounded  control  constraints. 

We  will  first  describe  the  Conjugate  Gradient  method  as  applied  to  a  free  end  point,  fixed  terminal 
time,  optimal  control  problem,  and  in  the  next  section,  we  will  show  how  it  is  adapted  to  solve  our  time- 
optimal  control  problem. 

Problem  Statement 

Given  the  system 

x(t)  =  F{x(t))  +  B(x(<))u(a  x(to)  =  xo  (4.1) 

I 

Find  u(t)  over  the  interval  (fo,  (/]  to  minimize  the  cost  function  given  by  I 


I’ 


(42) 
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J(u(t))  =  K{x,(t))  +  I  '  L(x(t),u(t))dt 


where  tf  is  fixed,  and  u(t)  is  assumed  to  be  unconstrained. 
IX’finc  the  Hamiltonian 


H(x(t),  pit),  u(0)  =  L(x(t),  u(0)  +  pr(t)[F{x(t))  +  B{x(t))u(t)}  (4.3) 


Then  die  necessary  conditions  as  give  i  by  the  Minimum  Principle  are  the  same  as  equations  (3.6H3.10) 
except  for  the  boundary  conditions  (3.8)  which  arc  replaced  by: 


x{to)  =  to 

P'(lf )  =  d-£(x'(1/)) 


(4.4) 


Solution  Procedure 
Define 

SM 

Hu{x[t),  p(t))  =  ^(x{(),p(i),u(t))  =  BT(x(t))p(t)  (4.5) 

Let  superscript  f  represent  the  iteration  number,  and  assume  that  we  start  with  an  initial  estimate  of  the 
optimal  control  trajectory  ul(t). 

At  the  t'th  iteration, 

1.  Using  u'(t),  integrate  the  state  equation  forward  from  time  to  tf,  with  x[to)  =  xq,  to  obtain  r’(t). 
Then,  substituting  *‘(t)  and  u'(t)  into  the  costate  equation,  integrate  it  backward  from  tf  to  fo  with 

m  -  %{*%)) 


to  obtain  p'(t). 


36 


Compute 

g'(t)  =  Hu{p'(t),x'(t))  (4.6) 

2.  Determine  conjugate-gradient  direction  using: 

«'(<)  =  0,'(O  +  0,'~‘«i-,(O  (4'7) 


where 

0 ==  - 

/,  V-,T«)i»-,U).« 

j3*‘_l  =  0 

3.  Compute  next  control  by. 

u<+1(0  =  u'  -  o'V(t) 


if  t  >  1 
if  t  =  1 


(4.8) 


(4.9) 


where  a'  is  chosen  using  a  one-dimensional  search  to  minimize  y(u,+l(<)). 

4.  Repeat  the  whole  procedure  with  i  =  t  +  1  until  /{■)  does  not  improve  significantly. 


Control  Constraints 

To  take  into  account  constraints  on  the  magnitude  of  the  control  as  given  in  equation  (3.16).  the 
above  procedure  is  modified  as  follows  (due  to  Pagurck  &  Woodsidc[13]): 

1.  Assume  that  W';  is  die  saturation  region  of  u)(<);  define  the  scale  function 

wj{L)  —  0  for  t  £  W'},  and 

=  l  elsewhere 

Note:  subscript  j  refers  to  individual  components  of  the  corresponding  vector. 

2.  When  computing/)'  '.  u',T(t)g'(t)  is  used  in  place  ofg'((). 

3.  After  computing  u' 4-1  according  to  equation  (4.9),  u'+,(f)  is  truncated  at  the  upper  and  lower 

bounds  before  it  is  used  in  the  computation  of  J(u,  +  I(()). 
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4.3  Algorithm  for  the  Time-Optimal  Problem 

In  order  to  apply  the  conjugate  gradient  method  as  presented  in  the  last  section,  the  lime-optimal 
problem  as  stated  in  section  3.1  is  modified  as  follows: 

1.  A  sequence  of  fixed  terminal  tunc,  free  end  point  problems  are  solved  instead  of  tire  original  free 

terminal  time  problem. 

2.  The  fixed  end  point  constraint  is  handled  by  means  of  a  quadratic  penalty  function,  that  is.  we  solve 
the  follow  ing  problem: 

Given  the  dy  namical  equation  described  by  equation  (3.1).  find  a  contiol  u(t)  t  W  so  as  to  minimize 
the  follow  ing  cost  function: 

J  =  (dll) 

subject  to  x(to)  —  xp.  with  fy.  tj  and  xj  given. 

If  tf  is  too  small,  i.e.,  tj  <  Tmin,  where  Tmi„  is  the  minimum  time  solution,  the  system  cannot  reach  z/ 
with  die  control  in  Q,  hence  J  will  not  be  close  to  zero.  As  </  increases  and  approaches  Tmin,  however, 
the  optimum  J  value  will  decrease,  and  the  smallest  tj  such  that  J  is  zero  (within  a  certain  tolerance)  is 
the  solution  to  the  original  time-optimal  problem. 

Choice  off/ 

We  can  always  start  with  a  very  small  tj  and  gradually  increase  the  value  of  t{.  but  this  will  take  too 
long  as  each  round  (t.e.  solving  die  modified  problem  with  a  given  tj)  by  itself  takes  a  long  time  (when 
run  on  a  POP  11/34  mini-computer).  Hence  we  will  make  use  of  the  special  structure  of  the  opdmal 
control  to  provide  an  estimate  of  Tmin. 

It  was  found  from  some  preliminary  runs  dial  in  an  optimal  solution,  one  pair  of  controls,  cither 
U|  and  U2  or  uj  and  u.j,  always  approaches  bang-bang  with  only  one  switching,  and  die  form  of  the 
other  pair  will  depend  on  the  relative  magnitudes  of  Oj  and  4>j.  which  define  the  final  position  of  the 
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arm  (henceforth  we  will  assume  that  z<,  =  0.  i.e..  we  are  interested  in  moving  the  arm  from  an  upright 
position  to  any  specified  imal  position;.  Although  the  two  pairs  of  controls  arc  coupled  tliroogh  tlic  system 
equation,  the  coupling  is  not  '.cry  strong,  and  one  can  clearly  identify  the  pair  U|  and  u/  as  affecting  die 
angle  0  much  more  strongly  than  ut  and  it  j.  and  similarly,  die  pair  U3.  u  1  affects  <p  much  more  strongly. 
Hence  the  time  taken  for  the  arm  to  move  from  8  =  0  to  8  —  6/  is  determined  mainly  by  U|  and  U2,  and 
is  only  slightly  affected  by  n  t  and  u  1,  the  same  applies  to  4>  with  u 3,  u4  exchanging  roles  with  u  1 ,  u 2. 

Hence  to  find  die  time  taken  for  .he  ann  to  move  from  0  =  <p  =  0  to  8  =  0f,  <j>  =  0,  we  will  keep 
t*3  and  n  1  to  be  zero  (thereby  ensuring  «*>  to  stay  0  throughout)  and  find  a  bang-bang  control  that  will  take 
8  to  0j,  this  is  a  much  easier  problem  to  solve  because  we  need  only  to  search  over  the  switching  time, 
which  is  only  one-dimensional  and  can  be  easily  done  manually.  Similarly  we  can  find  the  time  taken  to 
move  from  8  =  <j>  =  0  to  0  =  0.  d>  =  <pj.  The  larger  of  the  two  values  found  above  will  be  taken  as  an 
estimate  of  This  value  was  found,  in  general,  to  be  greater  than  T,n,n  by  about  one  to  direc  ume 
steps  (each  time  step  is  5  msec).  Hence  the  initial  choice  of  tj  is  taken  to  be  three  time  steps  smaller  than 
the  estimated  T,nin,  and  we  need  to  solve  at  most  three  rounds  of  the  modified  problem  to  obtain  our 
solution. 

Choice  ofQ 

Q  is  chosen  to  be  diagonal  and  serves  to  weight  the  different  components  of  x  individually.  We  chose 
the  qu  that  corresponds  to  the  ,:i:ec  that  is  mainly  affected  by  the  bang-bang  pair  of  controls  to  be  twice 
the  value  of  the  test  I  Ins  is  because  as  die  iterations  proceed,  it  becomes  more  and  more  difficult  to 
reduce  (hat  error  term,  as  wc  arc  trying  to  reduce  the  transition  time  of  the  bang-bang  control,  making  q„ 
larger  helps. 

Choice  of  Initial  Guess  of  u(t)  in  the  Conjugate  Gradient  Method 


The  initial  guess  is  chosen  to  be 


39 


u,(f )  «b  0  for  t  =  I, . . 4  and  for  .ill  t  t  \ku  (4.12) 

and  wo  started  with  sc\cral  iterations  of  steepest  descent  before  switching  mci  m  die  conjugate  gradient 
method. 

Method  of  finding  a* 

As  mentioned  in  the  procedure  for  the  conjugate  gradient  method,  o'  is  chosen  using  a  one- 
dimensional  search  technique.  The  method  we  used  is  to  fit  a  parabola  to  duo.  points  of  a\,  chosen  so 
that  the  minimum  of  die  parabola  falls  within  the  two  extreme  s allies  of  the  u's.  o'  is  chosen  to  be  die 
\aluc  of  a  that  minimizes  the  parabola. 


4.4  Approximation  of  the  Optimal  Solution 

The  results  obtained  using  the  conjugate  gradient  method  for  a  particular  final  position  is  given  in 
figure  4-1.  From  this  figure,  we  can  sec  that  the  pair  u3  and  u.j  approaches  bang  bang  with  one  switching, 
but  not  the  pair  ut  and  1*2- 

The  optimal  solution  can  be  approximated  by  straight  line  segments  as  shown  in  figure  4-2,  die  slac 
trajectories  for  the  optimal  and  the  approximated  control  arc  shown  in  figure  4-3,  and  we  sec  that  the 
response  due  to  the  approximated  control  compares  favorably  with  the  optimal  solution.  Any  deviations 
from  the  desired  state  at  die  terminal  time  will  be  handled  by  another  closed-loop  control  law  which  will 
be  switched  in  after  the  open-loop  control  is  terminated. 

The  general  form  of  the  optimal  control  and  its  approximation  will  be  elaborated  in  Chapter  6. 


Chapter  5.  Regulation  at  the  Final  Position 


5.1  Introduction 

Since  the  arm  is  attached  to  the  base  plate  by  a  three  degree-of-freedom  "joint",  positive  steady-state 
tensions  in  the  tendons  are  required  to  maintain  the  arm  at  any  specified  finai  position.  The  required 
control  currents  can  be  calculated  by  setting 

*/  =  /(*/.«/)  =  0  (5  1) 

where  i/  is  the  specified  final  state  of  the  system. 

A  tif  that  satisfies  the  abo\c  equation  will  be  called  a  steady-state  control  for  the  set-point  x/. 

If  the  arm  is  initially  at  the  required  final  state  x/,  then  u/  will  keep  the  arm  at  i/  as  long  as  there 
is  no  external  disturbance.  However,  any  slight  disturbance  will  cause  the  arm  to  move  away  from  this 
equilibrium  position  because  the  equilibrium  achieved  by  applying  constant  open-loop  controls  «/  is  an 
unstable  one. 

Moreover,  the  transient  phase  open-loop  control  that  brings  the  system  from  initial  to  final  state 
is  based  on  a  reduced-order  model  of  the  system,  and  also  in  order  to  implement  it,  it  is  necessary  to 
approximate  the  form  of  control  by  straight  line  segments.  The  open-loop  control  can  only  be  stored  at  a 
few  points  and  the  control  law  at  other  points  is  derived  by  interpolation.  Hence  at  the  end  of  the  transient 
phase  during  which  open-loop  control  is  applied,  the  final  state  reached  by  the  system  is  not  X/,  but  rather 
somewhere  in  the  vicinity  of  it. 

In  view  of  the  above,  closed-loop  feedback  control  is  required  to 

1.  bring  the  system  to  the  desired  final  state  x/, 

2.  maintain  the  system  at  x /  for  any  amount  of  time. 

5.2  Linearised  Model 
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Figure  5-1.  Block  diagram  for  ihe  closed-loop  feedback  control  scheme 

Let  xj  denote  the  desired  final  state,  and  u /  denote  the  steady-state  control  that  satisfies  equation 

(5.1). 

Define 

1.  State  perturbation  vector  6x(t): 

6x(t)  =  x(t)  —  x/ 

2.  Control  correction  vector 

5u(f)  =  u(<)  —  Uf 

Then  the  control  objective  can  be  stated  as  follows: 

Given  6x(t),  find  0u(r),  t  >  t  such  that  future  state  perturbation  vectors  6x(r )  arc  as  small  as 
possible  for  all  r  G  (t,  oo),  or  find  a  controller,  as  depicted  in  figure  5-1  that  will  accomplish  this. 

We  will  employ  the  linear-quadratic  approach  to  designing  the  controller.  Since  wc  arc  trying  to  keep 
the  system  at  a  fixed  set-point,  this  is  also  known  as  the  linear  regulator  problem. 

First  wc  must  derive  the  relationship  between  6x(t)  and  iu(f): 
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x (t)  and  u(t)  arc  related  b\  the  system  equation: 

x(l)  =  /(*(<),  u(t))  (5.2) 

expanding /(z(l),  u(t))  about  xj.  uj  in  a  l  ay  lor  series  expansion, 

/(*(<),  “(<))  =  f(z/<  u/)  +  %\zf>  U/)M0  +%(XJ>  U/)M0  +  h  o  t  (5 -3) 

where  hot  denotes  the  higher  order  terms  in  the  lay  tor  series  expansion. 

Since 

6i(t)  =  x(t)  —  if 


and 


*/  =  /(*// «/)  =  o. 


we  have. 


(5.4) 


Define 

a =!((»/.“/) 

B  =  £(«/,<*,) 

and  assuming  that  the  higher  order  terms  arc  negligible,  we  obtain  to  first  approximation  that 


(5.5) 


6i{t)  =  /Wx(f)  +  55u(0 


(56) 


For  the  remainder  of  the  Chapter,  the  £ -notation  will  be  dropped  for  simplicity,  and  the  linearized 
model  will  be  represented  as 


z(t)  =  /4z(t)  -f  £u(t) 


(5.7) 
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5.3  The  Linear  Regulator  Problem 
Given  the  linear  time-invariant  system 


i(t)  =  Ax{t)  +  Du(t)  (5  8) 

and  its  initial  condition  *o,  find  u(f)  such  that  die  following  quadratic  cost  functi  vnal  is  minimized 

J  =  [  (ir(t)Qx[t)  +  u'{t)Ru(t))dt  (5.9) 

JO 

where  Q  =  <?r  >  0,  R  =  Rr >  0. 

Derivation  of  the  solution  to  the  above  problem  can  be  found  in  Kwakernaak  &.  Sivan(IS).  It  is 
shown  that  the  optimal  control  u*(t)  is  given  by 

u*(f)  =  ~Gx{t)  (5  10) 

where 

G=^R-[BtP  (5  11) 

and  P  is  the  solution  of  the  following  Algebraic  Riccati  liquation  (ARE): 

0  =  —PA  —  ArP  —  Q  +  PBR  'BtP  (5.12) 

If  the  original  system  is  completely  controllable,  then  the  solution  to  the  above  ARE  exists.  In 
addition,  since  we  arc  assuming  that  wc  arc  observing  all  the  states,  the  system  is  completely  observable,  it 
can  be  shown  that  the  feedback  system  is  asymptotically  stable  (see  eg  Kwakernaak  &  Sivan[151). 

Wc  will  now  consider  the  choice  of  the  weighting  matrices  Q  and  R  in  the  cost  function  given  by 


equation  (5.9): 
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In  general,  the  selection  of  Q  and  R  is  not  a  simple  matter;  they  arc  usually  chosen  on  die  basis 
of  engineering  experience  coupled  with  simulation  runs  of  the  resultant  system  using  different  weighting 
values.  In  most  practical  applications.  R  and  Q  are  chosen  to  be  diagonal  because  in  this  way  we  can  in 
dividually  penalize  specific  components  of  x(<)  and  u(f ).  We  will  likewise  choose  R  and  Q  to  be  diagonal 
Since  there  is  no  reason  to  penalize  any  one  component  of  u(f)  more  than  the  others.  R  is  chosen  to  be 
of  the  form  pi .  where  p  is  a  positisc  scalar.  Once  Q  is  chosen,  by  adjusting  p,  we  can  vary  the  relative 
weighting  between  the  state  perturbation  and  control  perturbation  vectors. 

Specifically,  the  effects  of  p  are: 

1.  the  smaller  p  is.  the  faster  is  the  state  perturbation  vector  x(f)  reduced  to  zero,  this  corresponds  to  the 

poles  of  the  system  being  pushed  to  the  left  of  the  a-planc. 

2.  the  smaller  p  is.  the  larger  will  be  the  feedback  gain  matrix,  i  t.  G  in  equation  (5.10),  this  corresponds 

to  large  control  magnitude. 

Hence  there  will  be  a  tradeoff  between  the  speed  of  response  and  the  amount  of  control  to  be  put  into  the 
system. 

When  we  consider  the  maximum  allowable  magnitude  of  control  perturbation,  we  must  bear  in  mind 
the  control  constraint  which  is  given  by 


0  <  U»(0  <  Umar  for»  =  l,...,4 


(5  13) 


where  u,(f )  here  is  the  total  control  input  to  the  system. 

In  our  case,  since  we  arc  interested  in  reducing  the  position  error  to  zero  as  fast  as  possible,  we 
choose  not  to  penalize  the  velocity  terms.  Hence  Q  is  of  the  form. 


Q  = 


h  03 

0j  Oj. 


and  p  is  chosen  so  that  the  slowest  pair  of  poles  is  only  slightly  underdamped  so  that  there  will  not  be 
much  overshoot. 


f 


I 

I 
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I  . iking  all  these  into  consideration,  and  after  some  trial  and  errors  and  looking  at  the  closed-loop 
eigenvalues  and  resultant  runs,  p  is  chosen  to  he  0.2.  I'he  values  chosen  are  noi  optimal,  but  they  repre¬ 
sent  a  reasonable  choice  and  yield  a.i  acceptable  response.  The  response  can  of  course  be  unproved  upon 
by  further  fine-tuning,  but  we  are  not  putting  any  emphasis  on  it  at  this  stage. 

5.4  Determination  of  Steady-Stale  C  ontrol  input 

ITic  steady -state  control  u/(()  equircd  to  hold  the  arm  at  any  position  say  0j.  <pj.  \pj.  can  be  ob¬ 
tained  from  equation  (5.1).  where  =  (6j  Oj  ri>f  6/  Oj  v/)7  Since  j(()  is  a  6-vcctor,  we  will 
obtain  six  algebraic  equations  from  equation  (5  1 ).  but  the  first  three  do  not  involve  u(t)  and  only  give  us 
j,  =  X”,  =  X(j  =  0  which  corresponds  to  Of  =  0/  =  0/  ~  0. 

Ihereforc  from  equation  (5.1)  and  by  substituting  the  values  of  ij  --  [Of  0/  t/y  0  0  0)r  into 

it.  we  can  obtain  three  algebraic  equations  involv  mg  the  four  scalar  controls  u/,.  i  =  1 ,  ,  4;  by  solving 

these  three  equations,  we  can  obtain  uj.  However,  note  that  we  have  one  degree-of- freedom  in  choosing 
Uf  subject  to  the  three  equations  and  the  control  constraint  given  by  equation  (5.13).  By  specifying  any 
one  of  the  u/,'s,  we  can  uniquely  specify  die  other  three. 

There  arc  two  ways  of  taking  advantage  of  this  one  degree-of- freedom: 

1.  we  could,  for  each  position,  find  the  minimum  values  of  control  that  will  satisfy  the  three  equations  as 

well  as  the  non-negativity  contraint.  TfTcctivcly  we  arc  setting  one  of  the  u/,’ s  to  be  zero  and  solving 
the  three  equations  for  the  other  three  it/,'s.  I'he  one  to  be  set  to  zero  is  chosen  such  that  all  u/,'s  are 
non-negative. 

2.  we  could  introduce  another  algebraic  equation  involving  the  u/,'s.  and  by  solving  these  four  simul¬ 

taneous  equations  we  can  get  unique  values  for  the  u/,’s  Specifically,  the  equation  introduced 
IS 

4 

£  U/.  =  k 
•  ~1 


(5.14) 
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Since  all  the  u/,'$  are  non-ncgati\c,  the  larger  the  value  of  k ,  the  larger  arc  the  u/,’s.  In  this  context, 
this  degree -of- freedom  is  thought  of  as  providing  us  with  the  freedom  of  choosing  the  overall  control 
level. 

I  he  first  method  is  attractive  in  dial  it  provides  us  with  a  way  of  specifying  minimum  control  to  keep 
the  arm  at  any  desired  position,  since  we  do  not  want  to  expend  unnecessary  energy  holding  tlic  arm  at  a 
fixed  position.  However,  since  one  of  die  components  will  be  zero.  or  very  near  zero,  the  non-negatmty 
control  constraint  is  easily  violated  w  hen  wc  apply  the  feedback  control  law  as  |  iven  by  equation  (5.10). 

On  the  other  hand,  the  second  method  prov  ides  us  with  a  way  of  specify  mg  Uj  at  any  position  such 
that  YluI>  at  positions  within  the  working  space  is  the  same.  This  is  attractive  because  it  was  found 
that  if  this  is  so,  dicn  the  "main"  components  of  die  feedback  gain  G  as  given  in  equation  (5.11)  do  not 
vary  significantly  for  all  the  positions.  This  point  will  be  elaborated  further  in  Chapter  6. 

Hence  the  second  approach  is  used,  k  is  chosen  such  that  for  any  position  within  die  working  space, 
the  u/,'s  obtained  by  solv  ing  the  four  simultaneous  equations  arc  all  non-negative. 

The  value  of  k  found  and  used  is  7,  and  the  most  critical  position  (with  one  of  the  u/,’s  nearest  to 
zero)  occurs  approximately  at  a  =  -15°,  /3  =  10°,  1 1>  =  45?’. 


Chapter  6. 


Implementation  and  Simulation  of  the  Overall  (  ontrol  Structure 


6.1  Introduction 

As  suited  in  Chapter  1.  we  arc  interested  in  moving  the  ami  from  an  upright  position  to  any  specified 
final  position.  The  overall  control  scheme  for  this  movement  is  divided  into  two  phases.  In  die  first  phase, 
open-loop  time-optimal  control  approximation  is  applied  to  bring  the  arm  to  th:  vicinity  of  the  specified 
final  position.  In  die  second  phase,  a  closed-loop  linear  feedback  control  law  will  he  switched  in  to  bring 
the  system  to  the  desired  final  position  and  to  maintain  it  diere. 

In  order  to  implement  diis  control  scheme,  we  must  have  available  the  open-loop  control  and  the 
feedback  gain  for  every  final  position  that  can  he  specified.  Since  the  computation  time  of  die  former  is 
too  long  and  die  memory  requirement  for  the  latter  is  too  laige  lor  them  to  he  calculated  on  line  using 
the  PDF  11/45  which  is  used  for  the  control  of  the  tendon  arm.  they  must  somehow  he  precalculated 
and  stored.  Since  it  is  impossible  to  store  die  values  for  every  possible  final  position,  which  are  infinite 
in  number,  we  need  to  partition  the  enure  state  space  into  regions  and  piecompuie  die  open-loop  control 
trajectory  and  the  feedback  gain  of  a  representative  point  of  each  region  and  store  them  in  tables  of  some 
sort.  As  for  the  other  points  in  the  region,  we  can  either  interpolate  or  use  die  same  value  diroughout  a 
region.  The  latter  approach  is  employed  due  to: 

1.  the  feedback  gain  docs  not  change  significantly  within  a  region,  and 

2.  there  is  no  satisfactory  way  of  interpolating  die  open-loop  control,  and  since  feedback  control  is 

employed  in  the  second  phase,  we  rely  on  it  to  bring  the  system  to  die  desired  state,  and 

3.  it  is  simple. 

The  next  two  sections  describe  means  of  representing  and  storing  the  open  loop  control  trajectories 
and  the  feedback  gains.  The  last  section  describes  briefly  the  program  written  for  the  implementation  of 
the  overall  control  scheme. 
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6.2  Representation  and  Storing  of  Open-1  oop  Time-Optimal  Trajectories 

Symmetry  of  the  Control  Trajectories 

The  design  and  construction  of  the  tendon  arm  is  such  that  it  restricts  the  range  of  movement  of  the 
arm.  In  this  thesis,  this  range  vw ill  be  t.  ken  as 

0 

0 
K 

~4 

where  a.  0.  \p  arc  as  defined  by  figure  2-4. 

We  w  ill  divide  diis  space  into  four  quadrants  w  ith 

0</?  <  $ 

5  <  0  <  * 

*<p  < 

<  0  <  2* 

For  the  time-optimal  trajectories,  there  is  a  symmetry  among  the  four  quadrants  such  that  only  those 
of  the  first  quadrant  need  to  be  stored  and  those  of  the  other  three  quadrants  can  be  obtained  from  the 
corresponding  trajectory  in  the  first  quadrant. 

Let  u,[t).  i  —  1, . . 4  he  the  control  trajectory  that  will  bring  the  system  from  the  initial  position 
to  a  final  position  defined  by  0  =  Of,  <p  —  <f>j,  where  (Of.  <pf)  is  in  the  first  quadrant  (recall  that  the  time- 
optimal  control  is  obtained  using  the  reduced-order  model  and  hence  rp  is  not  relevant). 

Then,  to  obtain  the  control  trajectory  for 

1.  0  =  —Of,  4>  —  — 4>j' ;  exchange  U|(()  and  u-^),  exchange  ui(t)  and  u,j(<). 

2.  0  —  —Of,  <(>  —  <pj\  exchange  U|(()  and  Ui(t),  do  not  exchange  u3(t)  and  u^{t) 

3.  0  =  Of,<p  —  \  do  not  exchange  U|(<)  and  u-z (*).  exchange  U3(()  and  u4(t). 

Hence  in  all  die  discussion  that  follows,  we  will  take  the  final  position  to  be  in  the  first  quadrant. 


<0  <  2ir 

<*<\ 

4 


(6.1) 


the  following  correspondence: 
1st  quadrant 
2nd  quadrant 
3rd  quadrant 
4th  quadrant 
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Figure  6-1  Form  of  the  bang-bang  pair  of  controls 

Form  of  time-optimal  control 

As  suited  in  section  4.3,  it  was  found  dial,  in  general,  one  pair  of  controls  is  bang-bang  and  the  other 
pair  is  not  (both  pair  of  controls  could  be  bang-bang  for  certain  values  of  9j  and  </>/).  Which  pair  it  is  that 
is  bang-bang  depends  on  the  relative  magnitude  of  Oj  and  <pj. 

In  general,  the  pair  that  is  not  bang-bang  can  be  well-approximated  by  straight  line  segments,  and 
they  can  be  of  any  form  as  shown  in  figure  6-1.  The  pair  that  is  bang-bang  is  of  the  form  that  is  shown  in 
figure  6-2.  Hence  any  pair  of  controls  can  be  represented  by  the  numbers  h\,  <i,  <2.  h-  ij  as  shown  in 

figure  6-3. 

There  arc  two  ways  of  representing  the  open-loop  control  trajectory  for  any  final  position: 

1.  Represent  both  pairs  by  the  general  form  shown  in  figure  6-3.  By  choosing  appropriate  values  for  A|„ 
^2.,  <t  i,  <2:.  hi.  if'*  =  J.  2,  we  can  represent  any  of  the  forms  given  by  figure  6-1  and  the  bang- 
bang  control  of  figure  6-2,  (i  =  1  represents  ttj  and  tt2,  t  =  2  represents  ttj  and  u^).  Since  in 
implementing  the  control  scheme  with  a  digital  computer,  the  time  axis  is  discrete,  hence  the  t,}$  arc 
integer  numbers.  Using  this  scheme,  we  need  a  total  of  4  real  numbers  and  7  integer  numbers  to 


54 


“VI 

0,1  Oi  J 


Figure  6-1.  Various  forms  of  the  non-bang-bang  pair  of  controls 

represent  the  control  trajectory  of  each  final  position. 

2.  Represent  the  non-bang-bang  pair  by  the  general  form,  and  represent  the  bang-bang  pair  by  one 
number,  that  of  the  switching  time.  Hence  in  this  scheme,  we  need  2  real  numbers,  5  integers  and  1 
bit  to  indicate  which  pair  is  bang-bang. 

The  first  method  is  chosen  because  it  is  straightforward  to  code  and  at  this  stage  we  are  only  trying  out 
>'  "•  overall  control  scheme  using  simulation  and  hence  the  partitioning  into  regions  is  very  coarse  and  is  as 
shown  in  figure  6-4.  We  arc  not  too  concerned  yet  with  conserving  storage. 


in*. 
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Figure  6*3.  General  representation  of  any  pair  of  controls 

In  practical  implementation,  we  need  of  course  to  partition  the  state-space  into  a  finer  grid,  hence 
reducing  the  storage  requirement  per  point  will  be  one  of  the  prime  concerns.  We  can  then  consider  the 
following  two  ways  of  sav  ing  storage: 

1.  With  the  sampling  rate  (5  msec)  used,  the  maximum  time  step  corresponding  to  tj  is  less  than  100, 

hence  we  can  pack  two  time  values  (eg.  1 1  and  t2)  into  one  word. 

2.  In  actual  system  implementation,  the  control  will  be  applied  to  the  motors  via  digital-to-analog  con¬ 

verters  which  takes  integer  value  as  input,  hence  the  control  values  can  be  stored  as  scaled  integers 
instead  of  real  numbers. 

If  these  two  modifications  arc  implemented,  only  8  words  for  the  first  method  and  5  words  for  the  second 
method  arc  required  per  point. 

6.3  Representation  and  Storing  of  Feedback  Gains 

The  feedback  gain  G  of  the  linear  regulator  design  is  a  4  X  6  matrix.  If  gly  i  =  1, .  .  ..  4,  j  = 


1, . . 6,  represents  the  component  of  G,  then  gl}  is  the  contribution  of  x}  to  u„  t.e.. 
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components. 
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Figure  6-5.  Cross-hatched  area  showing  the  main  elemenis  of  main*  i7 


Since  all  four  controls  directly  affect  ip  and  ip,  we  will  treat  p,j.  g lti.  t  =  1 ,  ,  4.  as  main  components. 

Hence  as  indicated  in  figure  6-5,  the  cross-hatched  elements  arc  the  main  components. 

Table  6-1  shows  the  feedback  gains  for  the  various  positions  indicated  in  figure  6-6  and  for  ip  —  0. 
From  this  table,  we  can  sec  that  the  values  of  the  main  components  do  not  \  ary  much  for  different 
positions,  and  it  is  only  the  cross-coupled  terms  that  change  significantly,  for  example,  compare  921.  022  of 
points  5  and  6,  there  is  as  much  as  an  order  of  magnitude  of  difference. 

Table  6-2  shows  the  feedback  gains  for  position  3  (a  =  */ 6.  0  —  tr/4)  but  with  different  values  of 
ip.  It  can  be  seen  that  all  components  of  G  do  not  vary  significantly  for  different  ip.  hence  we  will  take 
them  as  the  same  and  equal  to  those  at  rp  =  0. 

Table  6-3  shows  the  feedback  gains  for  position  3  and  its  corresponding  positions  in  the  other  three 
quadrants.  To  a  first  approximation,  we  can  obtain  G  of  the  third  quadrant  from  the  first  quadrant,  and  of 
the  fourth  from  the  second  as  follows: 

exchange  row  1  and  2,  row  3  and  4,  and 

change  the  signs  of  all  the  elements  except  those  of  columns  3  and  6. 
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Figure  6-6.  Figure  showing  various  final  positions  used  in  Table  6-1 

For  implementation  purposes,  we  will  treat  the  main  components  of  G  to  be  the  same  for  all  posi¬ 
tions  in  the  four  quadrants,  using  those  of  the  upright  position,  and  store  the  non-main  components  for 
position  1,  3,  5  and  6  and  their  corresponding  positions  in  quadrant  2,  i.e..  die  partitioning  into  regions  is 
the  same  as  for  the  open-loop  control. 

6.4  Structure  of  Overall  C  ontrol  Program  and  its  Implementation 

Ilic  working  space  of  the  arm  is  defined  by  equation  (6.1)  and  is  partitioned  into  regions  as  shown  in 
figure  6-4.  The  open  loop  control  and  feedback  gain  of  the  representative  point,  called  the  center,  of  each 
region  arc  stored  as  described  in  the  List  two  sections. 

When  a  set-point  command  is  issued,  the  program  will  first  determine  which  region  the  final  position 
is  in.  after  which  the  entire  open-loop  control  trajectory  and  the  feedback  gain  G  for  its  center  arc  deter¬ 
mined.  these  will  be  used  for  the  final  position  specified.  At  the  same  time,  the  steady  state  current  at  the 
final  position  is  calculated. 

Ihc  open-loop  control  is  then  applied  to  the  system:  at  each  time  step,  generated  by  an  interrupt 
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from  the  real-time  dock,  a  control  \cctor  is  output  to  the  system.  M  the  end  of  the  first  phase,  determined 
by  the  final  time  of  the  open-loop  control,  the  closed-loop  linear  feedback  law  will  be  used:  at  the  occur¬ 
rence  of  each  interrupt,  the  state  of  the  system  is  read  wn  the  A  to  I),  from  which  die  stale  perturbation 
vector  Sx  is  calculated,  and  the  control  correction  vector  is  calculated  by 


u  —  uj  —  G6x 


(6.3) 


where  uj  is  the  steady-stale  control  vector. 

Ibis  u  is  then  output  to  the  system. 

Because  the  physical  tendon  arm  system  is  not  ready,  the  overall  c  uoi  scheme  will  be  simulated  on 
the  PDF  11/45  computer.  But  the  program  is  written  as  if  it  is  a  ical  time  system  except  that  a  software 
subroutine  is  being  substituted  for  the  arm,  and  the  time  scale  is  expanded  due  to  die  length  of  time 
required  for  the  subroutine.  The  block  diagram  for  the  program  is  given  in  figure  6-7. 

Figure  6-8  shows  the  state  trajectories  for  three  different  final  positions. 


Figure  6-7.  Block  diagram  for  the  overall  control  program 


Table  6- 1  Feedback,  gains  for  the  various  pos'ftions  shown  b 


Figure  6-6 

1  *.o*  .  ft  *0“,  i)>»  o* 

-4.02940*00  -2.1103D-01  1 .50440+00 

4.02940+00  2.1103C-01  1.50440+00 

-3.69600-01  -4.63190+00  -1. 53630+00 
2.89600-01  4.E319D+00  -1.53630+00 

Z  <*  «  15*  ,  (i  *  45* 

-3.49400+00  3. 68910-Cl  1.C416D+CC 

3 . 58890+CO  7.44370*01  1.04920+00 

1.70860-01  -4 . 3907D+0C  -1.03960+00 
5.52150-01  4.36730  +  00  -1  .09710+00 

3  oc  •  30°  .  fi  *  45* 

-3.63660+00  1 .03130+00  1. 03810+00 

3 .70280  +  00  1.17660  +  00  1.04800+00 

9 . 27020-C 1  -4.44620+00  -1.01310+00 
5.69050-01  4.40910+00  -1. 11800+00 

4  *>c  *  45*  .  p  *■  4S* 

-4.29140*00  1.69540+00  1.04170+00 

3.88810+00  1.63450+00  1.04020+00 

2.03070+00  -4.58050+00  -9.93080-01 
3.89140-01  4 .602S0  +  00  -1  .  12670+00 


-6.06780-01  -2.23330-02  8.30860-02 

6.06780-01  2.23330-02  8.30860-02 

-1.80810-02  -7.53780-01  -8-48500-02 
1.80810-02  7.53780-01  -8-4850D-02 


-5.39200-01  4.26700-02  6-90650-02 

5.95550-01  8.72050-02  6.91740-02 

2- 65770-02  -6.B7B10-01  -6-9136D-02 
4.17200-02  7 . 34140—01  -7-2071D-02 


-5.28840-01  1.10980-01  6-947bD-02 

6.30000*01  1.41530-01  6-91130-02 

9 ■ 91 82D-02  -6.52230-01  -6-80770-02 
3.3458D-02  7.44560-01  -7.32970-02 


-5.46040-01  1.70140-01  708240-02 

6.72430-01  2.016CD-01  6.86190-02 

1.96370-01  -6.17430-01  -8 ■ 7677D-02 
-5.84580-03  7.81070-01  -7.39710-02 
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h  oo30#  .  (b  s  0* 

-3  .  3416:  *30  1.3573O+C0  1 .06033+00 

3  -  62333  +  00  1.85340+00  1.09653*00 

-2.55940-C1  -4 .91960*00  -9.06543-01 
3-95950-01  4 . 74303  *  0  C  -1.13620+OC 

6  <*  «  30*  ,  p>  *  *10* 

-3 . "6333*00  -1.30653-02  9.7825D-G1 

4.02620+00  3.6434C-01  1.00330*00 

8.23850-01  -3.88340+00  -1.15230+00 
1.39340+00  4.16610+00  -1.09090+00 

7  <*  =45'  ,  p  .  22 

-3. 90040+00  2.67390*00  1.11030+00 

3.45750+00  2 . 5295D+C0  1.09460+00 

1 .04340+00  -5.05840+00  -8.36550-01 
1.21790-01  5.27180+00  -1.12410+00 

ft  45*  .  ^  67  5* 

-4.16030+00  7.13180*01  9.25940-01 

4.52810*00  9.10090-01  9.93793*01 

2-36930+00  -3.8769D+C0  -1.15570+00 
1.22490+00  4.01570+00  -1.12830+00 


-5.52950-01  1.67310-01  7 . 08430-02 

5.72160-01  2.12130-01  7.33490-02 

-7.62110-03  -7.14633-01  -6-21550-02 
3.66990-02  3.09380-01  -7.30630-02 


-5.1 2580 -C 1  -S. 66560-04  6-55430-02 

6.7718D-01  3.68480-02  6.5561D-02 

8.11490-02  -6.09830-01  -7.5ol3D“02 
1.1  1880*01  6.69003-01  -7 - 3458D-02 


-5.54160-01  2.86820-01  7.55400-02 

6.02140-01  2.9411D-01  7.35030-02 

1.08650-01  -6. 72510-01  -5-8113D-02 
-1.29450-02  8.73440-01  -7.22370-02 


-5.08270-01  6 . 6269D- 02  6 . 2946D-02 

7.4559D-01  1.12040-01  6-47840-02 

2.26600-01  -5.37390-01  -7.72280-02 
7.19720-02  5.44590-01  -7.5914D-02 


Table  6-2  Feedback,  gain  for  positions  with  c*  •  30\  p*  4-s* 
and  different  values  of  t|> 


I  tp  *=  -30° 

“3 .7 1233  +  00  1  . OC  240  +  C  0  1.05720+00  -5.3C1SD-C1  1.052SD-01  7.0857D-C2 

3.73140+00  1.15C60+C0  1.0610D+C0  6.3314D-01  1.37280-01  6-99600-02 

9.25530-01  -4.35680+00  -9.83310-01  1.00100-01  -6.41030-01  -6-61900-02 

5.71940-01  4.28930+00  -1.10160+00  3.4235D-02  7.27660-01  -7-23090-02 


-3.68660+00  1 .03230+00  1.03810+00-5.28840-01  1.10980*01  6-9478D-02 

3.70280+00  1.17660+00  1.04800+00  6-30000-01  1.41530-01  6-9113D-02 

9.27020-01  -4. 44820+00  -1.01310+00  9-91820-02  -6.52230-01  -6-80770-02 

5-69050-01  4.40910+00-1.11800+00  3.34580-02  7.4456D-01  -7-3297D-02 


3  ?J>  •  +  30* 

-3. 65570+00  1.06440+00  1.01930+00  -5.26940-01  1.16920-01  6.81260-02 

3. 67060+00  1 .20220-00  1 .03500+00  6.26420-01  1 .45770-01  6-82660-02 

9.27450-01  -4.54150  +  00  -1  .041 1C  +  00  9 . 8231 D-02  -6 . 6371 D-01  -6-9876D-02 

5.63790-01  4.53720+00-1.13220+00  3-25310*02  7.62480-01  -7.41580-02 
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Table  6-3  Feedback  gains  fbroc.*30,’1  /2>--45°  IT  II 

and  its  corresponding  positions  in  f\/*\ 

the  other  3  quadrants  \Cy~ 

X  I 

1 


-3. 68660  +  00  1  .0323D  +  00  1.03810+00 

3.70280+00  1.17660+00  1.04800+00 

9.27020-01  -4.44830+00  -1.01310+00 
5.69050-01  4.40910+00  -1.11800+00 

X 

-3.83080+C0  -1. 15240+00  1.05070+00 

3. 01380+00  -4.72C5D-C1  I.009'3+C0 

-1.25740-01  -4.18340+00  -1.16820+00 
1 .46130+00  4.65fae0+00  -9.91540-01 

x 

-3.70280+00  -1.17660+00  1.04800+00 

3.66650+00  -1.03230+00  1.033:0+00 

-5. 69060-01  -4.40=10+00  -+  .11600-00 

-9.27010-01  4.44830+00  -1.01310+00 

X 

-3.62380+00  4.75280-01  1.00840+00 

3.07210+00  1.15040+00  1.05120*00 

-1 .44440+00  -4.65860+00  -9.91583-01 
1  .39260-01  4.18380  +  00  -1.16830  +  00 


-5.28840-01  1.10980-01  6-94780-02 

6.30000-01  1.41530-01  6-91130-02 

9-91820-02  -6.5223D-01  -6-B077D-02 
3.3458D-02  7.44S6D-01  -7.32970-02 


-5.4407D-01  -1.25122-01  7 . 04840-02 

6 . 2403D-0 1  -7.08760-32  6.66320-02 

-2.1993D-02  -7.080BD-01  -7.5408D-02 
1.18710-01  7 . 03423-C 1  -6-79170-02 


-6.30000-01  -1.41530-01  6-91I3D-02 

5 . 2SB4  D -0 1  -1.10980-01  6-9J780-02 

-3.3459D-C2  -7.44550-01  -7.32970-02 
-9 . 91 82D-02  6.52230-01  -6-80770-02 


-6 . 2393D-0 1  7.11270-02  6-6653D-02 

5 . 4358D-0 1  1.24900-01  7 . 0466D-02 

-1.18300-01  -7.08420-01  -6-79140-02 
2.20270-02  7.08140-01  -7-54070-02 


Chapter  7. 


Conclusions 


7.1  Summary 

In  this  thesis,  a  mathematical  model  describing  the  dynamics  of  the  tendon  arm  system  has  been 
developed.  From  this,  we  obtained  a  reduced-order  model  of  the  system  and  applied  die  Minimum 
Principle  and  the  conjugate  gradient  method  to  obtain  the  time-optimal  solution.  It  was  found  Uiat  die 
optimal  solution  is  not  bang-bang  but  that  it  contains  singular  arcs.  But  it  was  also  found  that  these 
singular  arcs  can  be  approximated  very  well  by  straight  line  segments,  this  approximated  control  is  then 
utilized  to  form  part  of  the  overall  control  scheme. 

The  open-loop  tendon  arm  system  was  found  to  be  unstable,  and  hence  to  maintain  the  system 
at  any  state,  closed-loop  feedback  control  is  required.  The  feedback  law  was  designed  using  die  linear 
regulator  design  procedure,  linearizing  the  nonlinear  dynamics  about  die  final  state  and  the  nominal 
control  required  to  keep  the  system  there. 

''  ’  e  two  control  schemes  arc  combined  with  the  first  phase  being  open-loop  time-optimal  control, 
bringing  die  system  from  its  initial  state  to  a  waypoint  in  the  vicinity  of  the  final  state,  the  second  phase 
then  employs  die  closed-loop  control  law  to  bring  the  system  to  the  final  state  and  to  maintain  it  there. 

It  was  intended  initially  to  implement  the  overall  control  scheme  on  the  actual  physical  system,  but 
due  to  unforeseen  circumstances,  this  was  not  possible,  instead,  digital  simulations  of  the  system  with  the 
control  scheme  implemented  were  done. 

7.2  Areas  for  further  work 

There  are  a  few  directions  that  we  can  go  from  here: 

1.  Implement  the  control  scheme  on  the  actual  physical  system  —  this  is  the  most  natural  extension  to 
the  present  work.  I  lowcvcr,  before  this  can  be  done,  there  arc  a  few  problems  to  be  taken  care  of: 
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a.  The  control  vector  of  our  problem  is  formulated  in  terms  of  input  currents  to  die  motors,  idle 

drivers  for  the  tendon  arm  motors,  however,  are  voltage  amplifiers,  hence  we  have  to  reformu¬ 
late  and  solve  our  problem  in  terms  of  voltage  inputs.  This  can  be  easily  done  however,  and  the 
way  to  do  it  is  show  n  in  Appendix  F. 

b.  The  linear  regulator  design  assumes  full  state  feedback.  For  die  tendon  arm  ,  we  have  only  angle 
measurements  but  not  velocity  measurements,  we  need  to  find  some  means  of  constructing 
the  full  state  (the  simplest  way.  of  course,  is  to  use  backward  differencing  of  the  angles  to 
approximate  the  velocity  terms). 

c.  in  the  simulation  of  die  control  scheme,  a  very  coarse  grid  is  utili/.cd  to  partition  die  state  space. 

In  actual  implementation,  a  finer  grid  has  to  be  used,  and  the  problems  of  how  many  grid 
points  to  use  and  where  to  place  them  have  to  be  considered. 

2.  Investigate  other  means  of  simplifying  the  model  —  die  biggest  disadvantage  of  die  present  control 
scheme  is  dial  die  diird  dcgrcc-of- freedom  ,  namely,  xp,  is  not  being  controlled  during  the  first  phase 
of  movement,  this  is  due  to  the  approach  employed  in  simplifying  die  system  equation.  It  was  found 
that  the  coupling  between  0  and  (p  is  not  very  strong,  thus  it  may  be  possible  to  simplify  the  system 
equations  while  retaining  the  full  order  dynamics. 

3.  The  motivation  of  using  time-optimal  control  initially  is  because  of  its  bang-bang  solution  nature  (t  .e. 

in  the  absence  of  singularity).  It  would  be  interesting  to  formulate  the  time-optimal  control  problem 
as  one  having  a  discrete  control  set  constraint,  i.e., 

u,(«)  G  {0,  umaz} 

and  find  out  what  the  form  of  the  optimal  solution  is.  It  should  also  be  interesting  to  formulate  the 
time-optimal  problem  based  on  the  full  order  mode!  and  solve  it,  if  possible,  to  see  whether  it  is 
bang-  bang. 


4.  In  our  control  scheme,  we  have  utilized  die  measurements  of  die  angles  0,  <f>,  and  \p  but  not  die  four 


68 


motor  shiill  angles.  Investigate  other  control  strategics  that  will  take  advantage  of  the  availability  of 
all  seven  angles. 


1 
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Appendix  A.  Deriving  the  equations  of  motion  of  the  system  when  either  pair  of 
tendons  is  completely  unwrapped  from  the  arm 


Due  to  the  way  the  four  tendons  arc  wrapped  around  the  arm,  at  any  one  '.imc  it  is  possible  for  only 
one  pair  to  be  completely  unwrapped.  Hence  there  arc  three  different  sets  ol  equations  describing  the 
motion  of  the  system  depending  on  the  values  oftu  -f  X  and  a/  +  X '  (refer  to  figures  2- 7(a)  and  2-8(a)  for 
the  definitions  of  u/,  X,  u/,  X',  where  rl,  is  now  die  point  at  which  a  tangent  from  P,  touches  the  arm,  all 
projected  onto  the  x'  —  y'  plane). 

The  three  cases  correspond  to: 

1.  lo  -f  X  <  3ir/4  andu/  -(-  X'  <  37r/ 4,  both  pair  of  tendons  arc  properly  wrapped  on  the  arm,  this  is 

the  normal  mode  of  operation. 

2.  -f  X  >  3?r/4  and  lo1  -f-  X'  <  3rr/4,  the  first  pair,  corresponding  to  tendons  1  and  2,  is  completely 
unw  rapped,  whereas  the  second  p air  remains  wrapped. 

3.  w  +  X  <  3ir/4  and  u/  +  X'  >  3ir/4,  the  first  pair  remains  wrapped,  whereas  the  second  pair  is 

completely  unwrapped. 

The  equations  of  motion  corresponding  to  case  1.  have  been  developed  in  Chapter  2;  those  of  die  last  two 
cases  will  be  developed  in  this  Appendix. 

AT  Tendons  l  and  2  arc  completely  unwrapped 

When  w  -f  X  >  3rr/4,  where  uj  and  X  arc  still  being  defined  by  equations (2.7)  and  (2.8),  tendons  1 
and  2  are  completely  unwrapped,  die  situation  is  shown  in  figure  A-l. 

The  directions  of  F\  and  Fi  (the  tensions  in  tendons  1  &  2)  arc  now  given  by  Q\P\  and  Qil’i 
respectively,  and  equations  (2. 12) (2.13).  (2.17)-{2. 18)  arc  modified  to 
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Figure  A-l.  Schematic  diagram  showing  the  arm  and  tendons  1  &  2(projected  onto  the  i'  — 
plane)  when  u>  4  \  >  3*/4. 


L,  =  /.  =  Q,P,  = 


4 


La  =  (2  =  Q2P2  — 


(acosflsint/i - —  p)2  4"  (acos0cost/>  — — p)2  4  (6  4  asintf)2 

y/2  V2 

li 

2ab sin 0  4  a2  -f  b2  -f  p2  +  v2/m cos 0(cos  t£>  —  sin  ip) 


(— acosflsint/;  4-  ~p)2  +  {—acosBcosrp - — p )2  +  (asintf  ~6)2 

y/2  s/2 

li 

— 2a6sin0  -f  a2  +  62  -(-  p2  4-  v 2 pa  cos  0 (cos  ip  —  sin  ip) 


Equation  (2.35)  now  becomes: 


Resultant  torque  acting  on  the  arm  about  point  O 


=  OQi  X  Fi  +  OQi  X  F2  4  OR3  X  Fj  4  ORa  X  F4  +  OG  X  rAg 

-  x  «;Pi + x  + wk\oh>  x  r;pi 

4-  n—pki  X  RIPa  +  mgOG  X  GD 
\P-aP 4 1 

=  *T,  4  ;T2  4-  kT3 
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p  I  p4y  J 

7’,  =  —  —  pasinfl  —  ab  cos  0  cos  ip  4-  —  - pasinfl  +  abcosO  cosip 

Lllv/2  Mn/S 

4-  —  [ps sin  <p cos# sin(w'  -f-  X;)  —  23«(cos0sin ip  —  sin 0 sin <p cos  V')] 

P'3  L 

-f  —  [ps  sin  cos  0  sin(u)'  +  X')  +  ^^«(cos  <p  sin  ip  —  sin  0  sin  <p  cos  V>)] 

L4 

4-  mgd( sin  <p  sin  ip  4-  cos  <p  sin  0  cos  ip) 

p  1  f.  1 

T,  =  —  — posing  4-  d>  cos  0  sin  ip  4-7“  — pa  sin  0  —  06  cost?  sin  V< 

Mv/2  Mv/2 

4-  —  [— ps  sin  4>cos0cos{u/  4*  X*)  —  2$s(cos  <p  cos  ip  4-  sin  5  sin  <p  sin  V1)] 

4-  —  [— ps  sin  <£  cos  0  cos(u/  4"  X')  4”  Z4s(cos  <p  cos  ip  4"  sin0Bin^sinV>)] 
L4l 

4-  m<7d(sin$co8^  —  cos^sinflsin  ip) 

T3  =  (—-  4-  ^  — pa  cos  0(cos^  4- «n  V>) 

\L,  L2/y/2 

4-  4-  p^ps[sin0sin0cos(X'  4~aO  —  cos0sin(X'  4*m0] 


In  equations  (A.4HA.6),  L\  and  L2  arc  as  defined  in  equations  (A.l)  -(A.2),  the  others  arc  defined  as  in 
equations  (2.19H2.32). 

A.2  Tendons  2  and  4  arc  completely  unwrapped 

Following  the  same  procedure  as  in  section  A.l,  when  i</  4"  X'  >  3x/4,  the  directions  of  F3  and  F < 
will  be  given  by  QjPj  and  Q\P\  respectively,  and 
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Lj  =  =  QjPj  =  ((— a  cos#  cos  t#  —  a  sin  0 sin  0  sin  ip  —  -  —  p)2 

v/2 

+  (a  cos  #  sin  #  —  a  sin  #  sin  0  cos  ip  -|-  - —  p)2 

v"2 

4~  ( — a  sin#  cos  0  —  1)2]$ 

=  [s2  -(-  t1  4-  p2  +  \/2 ps  cos  #(cos  ip  -f-  sin  ip) 

+  '/2pssin  #sin0(sin  ip  —  cos  ip)  1st  sin#cos0]^  (4.7) 

La  =  I4  =  Q^P\  =  ((s  cos  <p  cos  ip  a  sin  #  sin  0  sin  ip  -| — p)2 

y/2 

+  ( — a  cos# sin  ip  a  sin  #  sin  0  cos  ip - p)2 

s/2 

4-  (a  sin#  cos  0  —  t)2]4 

=  [a2  -j- 12  -f  p2  +  \/2pacos#(co8  ip  -f-  sin  ip) 

-f-  V^pa sin  # sin 0(sin  ip  —  cost p)  —  2 at  sin  # cos 0]^  (4.8) 


P  Po 

T\  =  pasin0cos(w -f  \)  —  Ziacos0cos#] -f-  —[— pa  sin  0cos(w -)- X) -f-^acos0  cos#] 

Li  L2 

P  1 

4~  - pa  sin  #cos0  —  <s(cos#sin  ip  —  sin  # sin  0  cos  ip)] 

La  v/2 

p  j 

+  — — pa sin#cos0  4*  <a(cos#sin  ip  —  sin #sin0 cost#)] 

U  y/2 

4-  mgd(sin  <p Bin  ip  4~  cos # sin 0  cost#)  (4.9) 


P  *2 

T2  =  ~i  [pa  sin  0sin(w  4-  X)  4-  *iacos0sin  ip]  4-  7- [pa  Bin  0sin(u>  4~  X)  —  a2acos0sin  V»] 
L 1  Li 

p~  i 

4-  74 — pa 8in#cos0  —  ia(cos#cost#  4"  sin# sin 0Bin  VOl 
L  i  v/2 
P  1 

4-  ~[ — pa sin#cos0  4"  ta(cos#cos#  4"  sin#sin0sin #»)] 

L*  v/2 

4-  mpd(sin#cos\#  —  cos# sin 0 sin  ip) 


(4.10) 


T3  =  (7^  4-  7^)pacos0sin X 
L 1  Li 

P  FI 

4-  (  —  4 — -)  —  pa[cos#(sin  t#  —  cos#)  —  sin#sin0(cos  t#  4-  »in  V’)] 

L3  L4  y/2 


(4  11) 
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Note:  In  equations  (A.9HA.1 1),  Lj  and  L.\  arc  as  defined  in  equations  (A.7)  and  (A.8),  the  others  are  as 
defined  in  equations  (2.7M2.18). 

A.3  Equations  of  Motion 

The  equations  of  motion  for  the  two  eases  of  unwrapped  tendons  can  be  derived  following  the  proce¬ 
dure  in  subsection  2.2.4,  and  instead  of  using  equations  (2.36H2.38)  for  the  expressions  for  T\,  Ti ,  and 
T3.  equations  (A.4MA.6)  or  equations  (A.9HA.11)  are  used  depending  on  which  pair  of  tendons  are 
unwrapped.  The  full  detail  of  the  equations  corresponding  to  equation  (2.48)  is  given  in  Appendix  B. 
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Appendix  B.  Equations  of  motion  for  the  full  order  model 


B>  substituting  expressions  for  T\,  T2,  Tt  and  equations  (2.40)-(2.45)  into  equations  (2.39),  the  three 
equations  become. 


0\ 


J  COS  ip 


+  0 

+  ‘i>\ 


[r  n  ■  ,  Jin,  <91 1  .  df2  .  dl3 

r  At,  At.,  At,  At,  1 


I  W 


a<p 


Jm,  <9tl  .  dl2  dtj  dl4. 
~^{C"di>+Ciid^  +  Cl’<^  +C'4W\ 

'■  ~ [ci  |/|  +  c\ih  +  c\sh  4~  c,.,/,]  +  C15  -|-  6~ 

.  ;B,„  Ali  dl2  dtj  dl4 

+  ['"a*  + C|!a£  +  f|Vo  + 


+4" 

rl 

+  <P^j 
rl 


+  er 


<*3  au' 

^  +  Cl3^  +  CH^j 

dl,  df2  <»3  <«4l 

Cii^+Ci2^+C|3^+Ch^J 

,  d%  d\ 

{d#i+CviW  +C,:,^+CM^ 


dll  dfe  ,  dt3  .  df4' 

[Cl,de+Cl2^+ClJ^+CHd» 


+  *2|(- 

+  tfJ 

r 

+  2^ 


7-'m  ,  cri,  cri2  <r<3  crt4 
^[C,1dP  +  CyiM  +  C|  ‘d*2  +  CuM 

52  {-J  +  J3) sin 5 cos 0 cos ip  -f-  ^(c,0  +  c12g  +  C30  +  cl4%fc) 

S2^»ff  4-  ,  ^  4. ,  ^3  ,  „  d%' 

-2'  'V  +  12d^2  +  l3d02  +c'^2 

l/f  1M  .  „  •  ,,Jm,  d2/,  ,  d2^  ,  d2/3  ,  d2^. 

|(  2J3)s  n  sin0  +  r2(cn<gft^  +Cl2<5)a90  ^  c,2Q0d<p  +  C‘4dft9<^ 

1  oi  ,T  Ji  ,  a  ,  Jm,  &h  ,  ,  &h  ,  d2^ 

+  ^-TCO.«CO.tf  +  ^(C„  —  +C,2—  +C.3—  +CM  — )j 

,  „/Jlf  ■  ,  ,  Jm,  d2/,  ,  d2!,  ,  d2!,  ,  d\  ' 

+  2^^«n  rp  +  fj(ci \m  +  c„m  +  c13—  +  cM  — ) 


(B.l) 
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.  j  (9/,  a2  dll  &  K 

Jsm^-  72(c21-  +c22-  +c23-  +c„-) 


+  0j 

+  0 


r  *  ,  4,  «1  ,  «2,  ,  «3  ,  «n 

J  cos  0 cos  rl>-  -j  (c2)—  +c22-+c2J-+c21-)j 

«i  ,  ,  ^2  ,  ,  «»: 


<90 


<9t/j 


«3  ,  r  ?ill 

J00  +  24a0  J 


K 


B„ 


=  —  [c2l/|  +  C22/2  +  c2;t/j  4-  C2.l/.|]  +  c2r>  +  ^-^2"  C2lQQ  C22)q0  C23/SO  C24 


«2 


<513 


‘<90 


J<90 


4  <90 


/  B.n 

+  V<-y 


af.  ,  <%2  ,  <«3  ,  „  <5(4 1 

C2,^  +  Ci2a0+C23a0+C24^J 

<5(|  ,  «2  ,  <5(3  ,  <3(4 

_C2,a0  +  C22^+C2^+C24^ 

<5*/,  .  d%  &h  . 

C2I^P7  -r  C22-^rr  +  C23^Y  +  C243y| 


'<902 


‘<902 


Ja02 


’a?2 


+  <A 


ff  .  \  .  a  n.  &ll  ,  ^2.,  ^3,,  A, 

(J  -J3)  Sin  0  COS  08111^+  72^1^2  +C22^5  +C23^2  +C24^) 


i  /  2  ^ r« 

+  ^42 


d<p 2 

a2/!  ,  <3*(2  ,  a^  a2^ 

C2‘  =75  +  C22^  +  c23^2  +  C2« 


Ja02  '  a^2  J 


l<ty2 


‘av<2 


’a02 


4-  200 


-f-  200 


+  200 


,r  in  .  „  ,,Jm,  a2(,  a2/,  a%  a*/4 

(J  -  -03)8.000080  +  +  C22^  +  C23^  +  C24  — ) 


a2/ 


a2^ 


a2(3 


a2/4 


2*^J  cos  0  sin  0  +  +c22—  +  c23—  +  c24  — 

i,  .  ,  In,  a2(,  a%  a^  ,  „  a2/4 » 

203  COS  0  +  r,  (ctidrpd6  +c“di]dQ  +c*3dtpdO  +  24a090^ 


(/?.2) 


■j,n\  di{.  a2  di3  di, 

Cjim  +  Cj2^j  +  Cum  + Cjl;» 


,  r  ■  a  J"'(  j  i  ^i\ 

+  0  _J|Sln0_  _(Cj,__  +  C3J-  +CJJ-  +cJ4-) 

■if.  4,,  «i  ,  dh  .  dij  a,: 

+  Y3  -  rl  C| '<90  +  +  C,:i^  +  C"^;) 


_  tf,  ,  ,  .  ,  ,  ,  a,  a 2  a3  a, 

—  “lcJMi  +  cuh  ■+■  csjlj  +  cul\]  +  0-^j  Cj[flQ  Cj2$0  Cj3d(j  C34S$ 


,  iBm  < %  a2  a,  ai4l 

+  0  f  3l  ^7  I  c32  7T7  +  Cj. j—  +  C34  — 

r2  <90  <90  dip  dip 

,  ;B,J  a,  a2  a,  di4] 

+  i,^[C3iap+  °  2<90  +  C)3chp  + 


,  AiJ,n  Mx  ,  <?%,  &h 

+  9  r*  63  ld0i+  32 M  +  CJJ^  +  CJ4^ 

+  Wc3,^  +  C32^  +  C33^  +  C31^ 
+  9  r2  CJ  <902  +  32<902  h  3J<902  +  3,<902 

,  -2/mf  <92/,  <9%  <9%  <92/, 

+  0  T2  [CJ1^  +  C3i^T2  +  C33^  +  3  W2 
,  .nil,  ....  ,  Jm,.  &h  ,  . 


+  2<?0  -J3  COS0  +  ^(C3,^  +  C32—  +  c33 - 


l±+cA 


IjJm  .  Ml  ,  _  d\  ,  „  <9^  ,  _  A 


+  W^[C31  am  +  C3W  +  C3iw  +  CMrn> 

,  ,.  ,/^m  „  Mx  ,  „  <9%  ,  ,  <9%  ,  .  <92/4  ' 
+  2^r7  c3.^  +  ‘32^0  +  C^drjjd9  +  °3idxpd9 


In  the  above  three  equations,  the  values  of  ctJ,  L;,  lJt  i  —  1,  2,  3,  j  =  1 . 4,  will  depend  on  the 

values  of  w  +  X  andu/  +  X'  as  defined  by  equations  (2. 7>-(2.8)  and  (2.19H2.22). 


For w  +  X<  3 n/4. 


ci  1  =  [— pa  sin5cos(w  -f-  M  —  «iacos^cos0]/Li 
C|2  =  |  —  /M8in0cos(w  +  22a  COB  0  cos  ip}/ L3 

c2i  =  [posing sin(w  -f  X)  +  2iocoH08in  ip]/L\ 
c22  — •  |paain0sin(w  X)  —  *2nr,o«f>Bin  rp]/Lj 

c3|  =  pocostfsin  X/Li 
Cj2  =  pa costfsin  \/Lj 
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zi,  L\,  li,Z2,  L*i.  h  arc  as  given  by  equations  (2.11)  -(2.13)  and  (2.16)— (2.18). 


Force  -)-  X  >  3ir/4, 


c/ 1  =  [ —  pa  sin  0  —  ab  cos  0  cos  iP]/Li 

Vi 

Ci2  —  ( - pa  sin  6  -f-  abcos9  cosip]/L2 

Vi 

ci |  =  [ — pasict 6  +  abcosffsin  ip]/L\ 

Vi 

Cii  =  (■ — pa  sin  0  —  a6cos0sint/']/L2 

Vi 

Cji  =  pa  cos  9(cosip  -f-  sin  ip)/L\ 

Vi 

C32  =  — -  pa  cos  (cos  sin  t/»)/L2 


Li,  /|.  L2,  h  arc  as  given  by  equations  (A.l)  and  (A.2). 


Fora/  4-  X'  <  3*/ 4. 


c13  —  [ps  sin  </>  cos  0sin(u/  +  ^')  —  *js(cos^sin  ip  —  sin^sin^cos^J/La 
c)4  =  (pssin  pcosO  sin(a/  -)-  X')  -J-  a4s(cos0sin  ip  —  sin  0 sin  <^cost/»)]/L4 
C23  =  [ — ps  si n  <p  cos 0  cos(u/  X7)  —  Z3s(cos  0  cos  -f  sin  9  sin  <p  sin  ip)\/L3 
Cji4  =  (— pssin  <pcos0cos(uj'  -f-  X')  -f-  ztsfeos <p cos  ip  -f-  sinflsin  (f>sin  V<))/L4 
Cj3  —  pa(sin0sin0cos(X'  4-p')  —  cos0sin(X'  -t-p')]/L3 
C).j  =  ps[sin  $sin  0cos(X'  -j-  p')  —  cos0sin(\'  -f  p')l /L4 


Z3,  L3,  (3,  Z|,  L.t,  /.(  arc  as  defined  in  equations  (2.25H2.27)  and  (2.30)— (2.32). 


Fora/  -f  X'  >  3*/4, 
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C13  =  [ - ps  sin  ip  cos  6  —  si  (cos  <p  sin  ip  —  sin  6  sin  <p  cos  ip))/L3 

s/2 

ci 4  =  [ - pss\n<pcosd  -f  st(cos <p sin ip  —  sin 9 sin <p cos ip)}/ L4 

y/2 

c2i  —  [ - pssin<£cos0  —  st(cos  <j>  cos  ip  -f*  sin  <7  sin  <^>  sin  ip)\/L3 

s/2 

c*24  =  [  —  pssin^cos^  st(cos<p  cost/>  +  sin  0  sin  d>  sin  <p)}/L3 
s/2 

C33  =  - ps(cos<^(sin  ip  —  cos  ip)  —  sin  d>sin0(cos  tp  1 in  t/j)] /Z-3 

s/2 

C34  =  —  ps[cos<£(sin  t p  —  cos  ip)  —  sin  d>sin0(cos  ip  -f-  sin  ip)}/L^ 

s/2 

L3, l3.  L.  1,  /.1  arc  as  defined  in  equations  (A.7)  and  (A.8). 


For  all  cases, 

Ci 5  =  mgd{ sin  <p  sin  ip  -|-  cos  <p  si n  0  cos  ip) 
C'25  =  mgd{ sin  <p  cos  ip  —  cos  <p  sin  0  sin  t^) 


Equations  (B.l)— (B.3)  are  of  the  form, 

4 

h.i'e  +  hl2<p  +  ht3ip  =  g,(6,  <p,  ip,  0,  <j>,ip)+^2  qt]lj  i  =  1,  2,  3 

>=  1 

where  theh./s,  andg,/s  are  functions  of0,  <p,  ip. 

Written  in  component  form, 


'hn 

h,  2 

hu' 

V 

9i{0,<p,  ip,0,<i>,  ip) 

’<7i 

912 

913 

914 

h 

h-u 

hn 

hn 

4> 

— 

9>(6,<P,  ip,9,4>,ip) 

+ 

921 

922 

92J 

924 

h 

h3 1 

4)2 

h33 

ip. 

.?j( 9,<P,  i p,9,<p,  ip). 

9ji 

9J2 

9J3 

9.14 

.4 

Define 

^11  ^12 

H  =  hn  h  n  fa 

h3\  h32  h33 


(BA) 


(B.5) 


Then  from  equation  (B.5), 


0 

V 

9i  l  9i2  9i3  <7h 

<t> 

=  H~' 

9i 

+  H~l 

9il  922  923  92) 

9i 

931  932  933  931 

7.' 

ft 

h 

+ 

b\ 

A  " 

h 

A 

Ar 

h 

A 

A1 

k 

h 

LAJ 


Define 


x  =  \9  <p  0  <)>  rl>\ 

h  hV 


Fn{x[tj)  = 


Bo(z(t))  = 


A 

h 

i4‘ 

*5 

*6 

A 

h 

./o. 

0  ' 

p 

0 

>4 

6s 

.  As  . 

/.IT 


a  6-vector 


a  6  X  4  matrix 


Then  equation  (B.6)  can  be  written  as 


x  —  F0(i)  -f  Bo(x)u 


which  is  equation  (2.48). 


NppcndicesC-l-  have  been  excluded  from  die  Memo  version  of  this  thesis. 
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Appendix  F.  Using  >oitage  instead  of  current  inputs 

Tltc  electrical  equation  of  motor  t  is  given  by. 

=  +  ^  (FI) 

where  L„,  R.  Ki:  arc  the  mot  s  inductance,  resistance  and  KMF  constant  respectively,  and  -j,  is  the 
angular  speed  of  die  motor. 

For  the  pancake  t>pe  of  motor  that  we  arc  using. 

La  0 

and  since  in  S  I.  units,  die  EMF  constant  and  the  torque  constant  are  equal,  we  will  use  the  symbol  K  for 
both  of  them. 

Hence  equation  (F.l)  can  be  written  as 

Vi  =  RIi  +  Kii 

or 

Ii  =  nVi-^  (F2) 

From  equation  (2.42),  the  dynamic  equation  of  motor  t  is  given  by, 

Jm 7,  4-  Bmii  +  Fir  —  Kli  (F.3) 

Substituting  equation  (F.2)  into  (F.3),  we  obtain, 

Jmii  +  (Bm  +  +  F,r  (F.  4) 

which  is  of  the  same  structure  as  equation  (F.3)  except  that  ( Bm  +  K2/R)  is  substituted  for  B,n  and  K /R 
is  substituted  for  K. 

Hence  all  die  equations  and  programs  that  have  been  developed  for  current  inputs  can  be  applied  to 
the  case  of  voltage  inputs  by  changing  the  values  of  the  damping  constant  B,„  and  torque  constant  K  of 


die  motor. 


Appendix  G.  Values  of  the  parameters  used  in  the  simulation  runs 


G.l 

Arm  Parameters 

a 

0.4064  to 

refer  to  figure  2-6 

b 

0.4064  m 

refer  to  figure  2-6 

d 

0.117m 

refer  to  figrre  2-6 

9 

0.2032  m 

refer  to  figure  2-6 

t 

0.2032  m 

refer  to  figure  2-6 

P 

0.02223  m 

radius  of  the  cylindrical  rod 

TO 

1.581  kg 

mass  of  arm 

J 

0.0906  kg  m2 

momcmt  of  inertia  of  am  about  X  —  X  and  Y  —  Y  axes 

h 

0.000407  kg  to2 

moment  of  inertia  of  arm  about  Z  —  Z  axis 

G.2 

Motor  Parameters  (PMI  motor  type  D12M4) 

r 

0.016  m 

radius  of  motor  shaft 

K 

0.11  A7m/A 

torque  constant 

Jm  0.00016  kgm2  moment  of  inertia  of  motor  shaft 

Bm  0.000135  N  m/rad  a~l  damping  constant 


The  rated  current  of  the  motor  is  4.4  A. 
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